旋转矩阵表示姿态XYZ坐标轴关系

本文为博主“声时刻”原创文章,未经博主允许不得转载。
联系方式:[email protected]

姿态的坐标轴XYZ在空间坐标系下的表示
旋转矩阵表示姿态XYZ坐标轴关系_第1张图片
其中左乘旋转矩阵 R l e f t R_{left} Rleft为:
R l e f t = [ q 0 2 + q 1 2 − q 2 2 − q 3 2 2 ( q 1 q 2 + q 0 q 3 ) 2 ( q 1 q 3 − q 0 q 2 ) 2 ( q 1 q 2 − q 0 q 3 ) q 0 2 + q 2 2 − q 1 2 − q 3 2 2 ( q 2 q 3 + q 0 q 1 ) 2 ( q 0 q 2 + q 1 q 3 ) 2 ( q 2 q 3 − q 0 q 1 ) q 0 2 + q 3 2 − q 1 2 − q 2 2 ] R_{left}=\begin{bmatrix} q_0^2+q_1^2-q_2^2-q_3^2 &2(q_1q_2+q_0q_3) &2(q_1q_3-q_0q_2) \\ 2(q_1q_2-q_0q_3) &q_0^2+q_2^2-q_1^2-q_3^2 &2(q_2q_3+q_0q_1) \\ 2(q_0q_2+q_1q_3)&2(q_2q_3-q_0q_1) &q_0^2+q_3^2-q_1^2-q_2^2 \end{bmatrix} Rleft=q02+q12q22q322(q1q2q0q3)2(q0q2+q1q3)2(q1q2+q0q3)q02+q22q12q322(q2q3q0q1)2(q1q3q0q2)2(q2q3+q0q1)q02+q32q12q22

你可能感兴趣的:(imu)