// error is sum of cross product between reference direction of field and direction measured by sensor
2. ex = (ay*vz - az*vy);
3. ey = (az*vx - ax*vz);
4. ez = (ax*vy - ay*vx);
5.
6. axyz是机体坐标参照系上,加速度计测出来的重力向量,也就是实际测出来的重力向量。
7. axyz是测量得到的重力向量,vxyz是陀螺积分后的姿态来推算出的重力向量,它们都是机体坐标参照系上的重力向量。
8. 那它们之间的误差向量,就是陀螺积分后的姿态和加计测出来的姿态之间的误差。
9. 向量间的误差,可以用向量叉积(也叫向量外积、叉乘)来表示,exyz就是两个重力向量的叉积。
10. 这个叉积向量仍旧是位于机体坐标系上的,而陀螺积分误差也是在机体坐标系,而且叉积的大小与陀螺积分误差成正比,正好拿来纠正陀螺。(你可以自己拿东西想象一下)由于陀螺是对机体直接积分,所以对陀螺的纠正量会直接体现在对机体坐标系的纠正。[/mw_shl_code]
但是向量的外积可以看做两个向量决定的平面的法向量方向,和向量间的误差没有任何关系。不是吗??[/mw_shl_code] |