wuzhiliang1234 发表于 2014-2-12 15:48
嗯,我试试你说的方法,非常感谢楼主指点迷津
楼主,你所用的带磁力计的传感器,通过
Yaw = -(0.9 * (-Yaw + init_gz*2*halfT) + 5.73 * atan2(init_mx*cos(Roll) + init_my*sin(Roll)*sin(Pitch) + init_mz*sin(Roll)*cos(Pitch), init_my*cos(Pitch) - init_mz*sin(Pitch)));
求出的yaw角度,在pitch 0~+90或-90任何角度都是很准确的吗?
我用的传感器没有带磁力计的。 |