四元数叉乘的几何意义?

四元数叉乘的几何意义?

惯性导航里讲解用四元数进行姿态更新的部分有详细推导:

这里实际上是经过严格的理论推导得出的结论,而龙格库塔法是通过近似求解微分方程。

最开始思考这个问题是因为要用EKF进行多传感器数据融合。px4的22阶速度位置估计的EKF程序中,在状态预测部分进行姿态四元数预测时,它的思想是通过陀螺测得的机体系下x、y、z三轴角度变化量(也就是陀螺输出*dt),然后将其转换成四元数。通过前一时刻的姿态四元数叉乘陀螺输出的delta四元数得到当前姿态四元数的预测值,完成状态预测。

这里我的理解是,既然px4利用姿态四元数叉乘陀螺输出的delta四元数可以更新姿态,所以两个四元数叉乘实际上是把第一个四元数看作一个数而不是某种旋转,第二个四元数则表示其本身的几何意义,即绕某轴转某角度。那么将前一时刻姿态进行一个旋转则为当前姿态。