|
楼主 |
发表于 2012-9-12 23:24:05
|
显示全部楼层
float _w,_x,_y,_z;
_x=Quat.x();_y=Quat.y();_z=Quat.z();_w=Quat.w();
float _p,_h,_b; //三轴旋转的欧拉角度
float _sp=-2.0f*(_y*_z+_w*_x);
if(fabs(_sp)>0.9999f)
{
_p=1.570796f*_sp;
_h=atan2(-_x*_z-_w*_y,0.5f-_y*_y-_z*_z);
_b=0.0f;
}
else
{
_p=asin(_sp);
_h=atan2(_x*_z-_w*_y,0.5f-_x*_x-_y*_y);
_b=atan2(_x*_y-_w*_z,0.5f-_x*_x-_z*_z);
}
这个是我惯性物体的四元数转欧拉角,但是转过去的角度还是不对,请指正。 |
|