2、IMU基础：惯性测量单元（IMU）的组成、工作原理与坐标系定义
惯性测量单元（Inertial Measurement Unit, IMU）是无人机姿态估计与导航控制的核心传感器组件。它通过测量物体在三维空间中的角速度与线加速度，为飞控系统提供高频、低延迟的姿态与运动状态信息。理解IMU的硬件组成、物理原理以及坐标系定义，是后续进行传感器融合、姿态解算与时序模型部署的前提。本章将从器件级原理出发，逐步建立从物理量测量到数学表达的完整认知链路。
2.1 加速度计：比力测量的核心原理
加速度计测量的是物体受到的比力（Specific Force），即单位质量上所受的非引力外力之和。在无人机应用中，加速度计输出的物理量并非单纯的运动加速度，而是包含了重力加速度分量的合成值。这一特性既是姿态估计的基础，也是需要特别注意的误差来源。
2.1.1 工作原理与敏感机制
当前无人机主流采用MEMS（微机电系统）加速度计，其核心结构为一个悬挂在弹性梁上的质量块。当加速度作用于芯片时，质量块因惯性发生位移，导致差分电容发生变化。通过测量电容差值，即可反推当前加速度大小。其简化力学模型可表示为：
F = m × a
其中 F 为质量块受到的惯性力，m 为质量块质量，a 为外部加速度。
电容变化量 ΔC ∝ 位移量 x ∝ 加速度 a在实际工程中，加速度计输出的是三轴分量（ax, ay, az），分别对应机体坐标系下三个正交轴的比力值。当无人机静止或匀速运动时，加速度计的三轴输出模长应等于重力加速度g（约9.8 m/s²），且方向指向天顶的反方向。
2.1.2 关键性能指标与选型依据
| 性能指标 | 典型值范围 | 对姿态解算的影响 |
|---|---|---|
| 量程 | ±2g ~ ±16g | 量程过小会导致高机动时饱和削波 |
| 零偏稳定性 | ±10 mg ~ ±50 mg | 影响静态姿态角的长期漂移 |
| 噪声密度 | 100 ~ 300 μg/√Hz | 影响动态姿态的抖动程度 |
| 带宽 | 100 Hz ~ 1 kHz | 带宽不足会引入相位滞后 |
2.2 陀螺仪：角速度测量的物理机制
陀螺仪用于测量物体绕三个正交轴的旋转角速度。与加速度计不同，陀螺仪不依赖重力方向，因此能够提供高频、瞬时的姿态变化信息。然而，陀螺仪存在积分漂移问题，长时间使用后累积误差会显著增大。
2.2.1 MEMS振动式陀螺仪工作原理
MEMS陀螺仪基于科里奥利效应（Coriolis Effect）工作。其内部有一个质量块在驱动方向做高频往复振动（通常为10~30 kHz）。当陀螺仪绕敏感轴旋转时，质量块在检测方向上会受到科里奥利力，该力的大小与角速度成正比：
F_c = 2m × (v × ω)
其中 v 为质量块的振动速度，ω 为输入角速度。
通过检测检测方向上的位移或电容变化，即可解算出角速度值。陀螺仪的三轴输出（gx, gy, gz）分别对应机体坐标系下的滚转、俯仰、偏航角速度。在姿态解算中，陀螺仪数据通常以较高的频率（如1 kHz）被采样，用于姿态的短时预测。
2.2.2 陀螺仪误差模型与补偿策略
- 零偏（Bias）：静止时输出不为零，需在启动时进行静态校准，记录偏移量并在后续测量中扣除。
- 温度漂移：零偏随温度变化，需建立温度补偿模型或使用恒温控制。
- 比例因子误差：实际输出与真实角速度之间存在比例偏差，可通过六位置法或转台标定。
- 随机游走（Angle Random Walk, ARW）：由白噪声积分引起，是姿态发散的主要来源。
2.3 磁力计：航向参考与地磁测量
磁力计测量地球磁场在机体坐标系下的三轴分量。由于地磁场在水平面上的投影方向指向磁北，磁力计可为无人机提供航向参考，弥补陀螺仪偏航轴积分漂移无法自修正的缺陷。
2.3.1 磁力计工作原理
常见的MEMS磁力计采用磁阻效应或霍尔效应。以磁阻式为例，其内部包含四个磁阻桥臂，当外部磁场方向变化时，磁阻值发生改变，导致电桥输出电压变化。通过三轴正交布置，即可测量空间磁场矢量。
2.3.2 磁力计标定与干扰抑制
磁力计在实际使用中极易受到机载电流、电机磁场、金属结构等硬磁和软磁干扰。硬磁干扰表现为固定偏置，软磁干扰表现为椭圆畸变。常用的标定方法为椭球拟合：
理想情况下，磁力计三轴输出在三维空间中构成一个球面（半径为地磁场强度）。
存在干扰时，球面畸变为椭球面。
通过最小二乘法拟合椭球参数，即可求解出偏移量和缩放矩阵，完成标定。2.4 坐标系定义：机体坐标系与世界坐标系
坐标系定义是IMU数据解释和姿态解算的数学基础。不同坐标系之间的转换关系直接决定了姿态角的物理含义和计算方式。
2.4.1 机体坐标系（Body Frame, b系）
机体坐标系与无人机机体固连，原点位于无人机重心。其三个轴定义遵循右手定则：
- X轴（Roll轴）：指向机头前方，绕X轴旋转为滚转运动。
- Y轴（Pitch轴）：指向机体右方，绕Y轴旋转为俯仰运动。
- Z轴（Yaw轴）：指向机体下方，绕Z轴旋转为偏航运动。
IMU的三个传感器均以机体坐标系为参考输出数据。例如，加速度计输出的az在水平悬停时应约为+1g（若Z轴向下为正），而陀螺仪的gz则对应偏航角速度。
2.4.2 世界坐标系（Navigation Frame, n系）
世界坐标系（又称导航坐标系）是固定在地球表面的参考系，通常采用东北天（ENU）或北东地（NED）约定。在无人机领域，NED坐标系更为常用：
- X轴（North）：指向地理北极方向。
- Y轴（East）：指向东方。
- Z轴（Down）：指向地心方向（即重力方向）。
姿态解算的目标就是确定机体坐标系相对于世界坐标系的旋转关系。这一关系通常用欧拉角（Roll, Pitch, Yaw）、四元数（Quaternion）或旋转矩阵（Direction Cosine Matrix, DCM）表示。
2.4.3 坐标系转换与姿态角定义
| 姿态角 | 旋转轴 | 范围 | 物理意义 |
|---|---|---|---|
| Roll (φ) | X轴（前向） | -180° ~ +180° | 机体左右倾斜程度 |
| Pitch (θ) | Y轴（右向） | -90° ~ +90° | 机头上下俯仰程度 |
| Yaw (ψ) | Z轴（下向） | -180° ~ +180° | 机头相对北向的偏转 |
从机体坐标系到世界坐标系的转换通常采用Z-Y-X的旋转顺序（先偏航、再俯仰、最后滚转）。对应的旋转矩阵为：
R = Rz(ψ) × Ry(θ) × Rx(φ)
其中 Rz、Ry、Rx 分别为绕Z、Y、X轴的基本旋转矩阵。2.5 案例拆解：IMU数据采集与坐标系验证
为加深对IMU组成和坐标系的理解，下面通过一个实际测试场景来演示数据采集与坐标系验证的完整流程。
2.5.1 场景背景与测试目标
某无人机开发团队在完成飞控硬件装配后，需要验证IMU传感器（型号：ICM-20602）的安装方向是否正确，以及坐标系定义是否与飞控软件一致。测试环境为室内无风环境，无人机放置在水平桌面上。
2.5.2 测试步骤与数据记录
- 静态数据采集：上电后等待2秒，以100 Hz采样率记录10秒的加速度计和陀螺仪数据。
- 水平姿态验证：计算加速度计三轴输出的平均值。若安装正确，应满足：ax≈0, ay≈0, az≈+9.8 m/s²（Z轴向下为正）。
- 旋转测试：手动将无人机绕Z轴顺时针旋转90°，观察陀螺仪gz输出应为正值（约+90°/s），且积分后偏航角增加约90°。
- 数据记录示例：
静态数据（平均值）:
ax = 0.02 m/s²
ay = -0.01 m/s²
az = 9.79 m/s²
gx = 0.01 °/s
gy = -0.02 °/s
gz = 0.00 °/s
旋转测试（绕Z轴顺时针90°）:
gz 峰值 = 92.5 °/s
积分结果 = 89.7°（误差 0.3°，主要来自积分漂移）2.5.3 结果分析与问题定位
测试结果显示加速度计静态输出符合预期，说明Z轴方向定义正确。陀螺仪旋转测试中，积分结果与真实角度误差仅0.3°，验证了陀螺仪比例因子和安装方向均正确。若发现az输出为负值，则说明Z轴方向定义反了，需要在软件中取反或调整安装方向。
2.6 常见误区与设计建议
- 误区一：将加速度计输出直接当作运动加速度。实际上，加速度计输出包含重力分量，只有在减去重力投影后才能得到运动加速度。
- 误区二：忽视磁力计标定。未标定的磁力计在室内环境中可能产生20°以上的航向误差，导致无人机偏航漂移。
- 误区三：坐标系定义不统一。不同传感器或算法库可能使用不同的坐标系约定（如ENU vs NED），混用会导致姿态解算结果完全错误。
- 误区四：采样时序不同步。加速度计、陀螺仪和磁力计的数据若未进行时间戳对齐，融合算法会引入额外的相位误差。