IMU与无人机机体轴不对齐（欧拉角[Roll:0° Pitch:180° Yaw:0°]）的转换方法及旋转矩阵咨询

核心逻辑 #

IMU的加速度、角速度等测量值是基于自身坐标系的，要转换到无人机机体轴坐标系，需要通过IMU到机体轴的旋转矩阵完成坐标变换。给定的欧拉角[Roll:0°, Pitch:180°, Yaw:0°]描述的是从无人机机体轴到IMU轴的旋转顺序（默认采用Roll→Pitch→Yaw，即X→Y→Z的旋转顺序），我们只需推导对应旋转矩阵，再利用正交矩阵的性质得到反向转换矩阵即可。

旋转矩阵推导（Roll→Pitch→Yaw顺序） #

欧拉角对应的旋转矩阵是三个单轴旋转矩阵的乘积，顺序为：先绕X轴转Roll角，再绕Y轴转Pitch角，最后绕Z轴转Yaw角。

单轴旋转矩阵定义 #

• 绕X轴（Roll）旋转φ的矩阵：

R_x(φ) = [1,  0,        0       ]
         [0, cosφ,  -sinφ]
         [0, sinφ,   cosφ]

• 绕Y轴（Pitch）旋转θ的矩阵：

R_y(θ) = [cosθ,  0,  sinθ]
         [0,     1,   0  ]
         [-sinθ, 0, cosθ]

• 绕Z轴（Yaw）旋转ψ的矩阵：

R_z(ψ) = [cosψ, -sinψ, 0]
         [sinψ,  cosψ, 0]
         [0,        0, 1]

代入给定欧拉角计算 #

将φ=0°、θ=180°、ψ=0°代入：

• cos0°=1，sin0°=0；cos180°=-1，sin180°=0
• R_x(0°)和R_z(0°)均为单位矩阵，不影响乘积结果
• 最终从机体轴到IMU轴的旋转矩阵为：

R_body_to_imu = [ -1, 0,  0 ]
                [  0, 1,  0 ]
                [  0, 0, -1 ]

得到IMU到机体轴的旋转矩阵 #

由于旋转矩阵是正交矩阵，其逆矩阵等于自身转置。这里R_body_to_imu是对称矩阵，转置后与原矩阵一致，因此IMU到机体轴的转换矩阵为：

R_imu_to_body = [ -1, 0,  0 ]
                [  0, 1,  0 ]
                [  0, 0, -1 ]

测量值转换操作 #

假设IMU输出的加速度矢量为a_imu = [a_x, a_y, a_z]^T，角速度矢量为ω_imu = [ω_x, ω_y, ω_z]^T，转换到机体轴下的矢量计算如下：

a_body = R_imu_to_body × a_imu
ω_body = R_imu_to_body × ω_imu

展开后的具体计算：

• 机体轴X方向加速度：a_body_x = -a_imu_x
• 机体轴Y方向加速度：a_body_y = a_imu_y
• 机体轴Z方向加速度：a_body_z = -a_imu_z
• 机体轴X方向角速度：ω_body_x = -ω_imu_x
• 机体轴Y方向角速度：ω_body_y = ω_imu_y
• 机体轴Z方向角速度：ω_body_z = -ω_imu_z

物理意义验证 #

绕Y轴（Pitch轴）旋转180°后，IMU的X轴和Z轴方向与机体轴的X、Z轴完全相反，Y轴方向保持一致，因此测量值的X、Z分量取反即可得到机体轴下的对应数值，与推导结果一致。

内容的提问来源于stack exchange，提问作者Mikadasi