参考博客内容： http://blog.csdn.net/shenxiaolu1984/article/details/50165635

使用opencv的库函数solvepnp， (success, rotation_vector, translation_vector) = cv2.solvePnP(model_points, image_points,camera_matrix, dist_coeffs, flags=cv2.SOLVEPNP_ITERATIVE)

可以得到rotation_vector 但是这个旋转向量为3*1，其输出值不为而旋转矩阵为3*3的，只有转换成旋转矩阵才能与Euler坐标进行转换（ roll yaw pitch），故需要转换成旋转矩阵（vector->matrix）经查找需要使用opencv中的cv2.Rodrigues函数进行转换成旋转矩阵，调用时需要注意在python2.7中按如下方式调用R=cv2.Rodrigues(rotation_vector)[0]，再借用MATLAB中的转换代码rot2euler函数：

function [euler] = Rot2Euler(R)

q0 = sqrt( 1 + R(1,1) + R(2,2) + R(3,3) ) / 2;

q1 = (R(3,2) - R(2,3)) / (4*q0) ;

q2 = (R(1,3) - R(3,1)) / (4*q0) ;

q3 = (R(2,1) - R(1,2)) / (4*q0) ;

yaw  = asin(2*(q0*q2 + q1*q3));

pitch= atan2(2*(q0*q1-q2*q3), q0*q0-q1*q1-q2*q2+q3*q3);

roll = atan2(2*(q0*q3-q1*q2), q0*q0+q1*q1-q2*q2-q3*q3);

euler = [pitch, yaw, roll];

但是我们发现第pitch坐标抖动很厉害，而且是在正负之间震荡，但是在一定范围内是随点头的幅度呈近似线性关系，所以考虑是坐标角度变换的问题，在减去180度发现是从0度直接到-360，所以是互补的问题：

if pitch1<=-180:

pitch1=pitch1+360

此时在正常范围内进行测试，基本准确。

在测试时不能启动，shape没有定义，思考后发现是当开启摄像头后未检测到人脸，就不会有数据传入shape，这样就是未定义了，在前面测量下dets=detector(frame,1)中dets的个数，如果小于1直接显示未检测到人脸，返回即可。

运行结果如下：