IMU基础原理：加速度计、陀螺仪、磁力计的工作原理与测量模型
IMU（Inertial Measurement Unit，惯性测量单元）是机器人、无人机、自动驾驶和姿态参考系统的核心传感器组件。要正确处理IMU数据，首先必须深刻理解三类传感器各自的内在物理机制、输出特性以及误差来源。本章将逐一拆解加速度计、陀螺仪和磁力计的工作原理，并建立后续滤波算法所需的测量模型，为多传感器融合打下坚实的数学与物理基础。
3.1 加速度计：测量比力而非纯加速度
加速度计的核心原理基于牛顿第二定律与胡克定律的结合。MEMS加速度计内部包含一个质量块（proof mass），通过弹性梁悬挂在固定框架上。当传感器沿敏感轴方向加速时，质量块因惯性产生位移，该位移改变差分电容的间距，通过测量电容变化量即可反推加速度大小。但需要特别强调的是，加速度计实际测量的是比力（Specific Force），即物体所受非引力外力之和除以质量，数学表达式为：
f = a - g其中，a 是物体在惯性空间中的绝对加速度，g 是重力加速度矢量。当IMU静止放置于桌面时，绝对加速度 a = 0，但加速度计输出 f = -g，即感受到向上的支撑力。这一特性使得加速度计在静态条件下可以充当倾角计——通过测量重力矢量在三个轴上的投影分量，计算俯仰角和横滚角。
3.2 陀螺仪：角速度测量与积分漂移
MEMS陀螺仪基于科里奥利效应（Coriolis Effect）工作。陀螺仪内部有一个质量块以固定频率沿驱动轴振动，当传感器绕敏感轴旋转时，质量块受到科里奥利力作用，在检测轴方向产生位移。该位移与输入角速度成正比，通过电容检测即可获得角速度值。陀螺仪输出的是载体相对于惯性空间的角速度 ω，单位为 rad/s 或 °/s。
陀螺仪的姿态解算原理是对角速度进行时间积分：
θ(t) = θ(0) + ∫₀ᵗ ω(τ) dτ然而，积分过程会累积误差。陀螺仪的零偏（Bias）即使很小，经过长时间积分也会产生显著的角度漂移。例如，一个零偏为 0.01°/s 的陀螺仪，积分 100 秒后就会产生 1° 的姿态误差。此外，陀螺仪还存在温度漂移、尺度因子非线性、随机游走（Angle Random Walk）等误差源。
| 误差类型 | 典型量级（消费级） | 对姿态解算的影响 | 抑制手段 |
|---|---|---|---|
| 固定零偏 | ±0.5 ~ ±5 °/s | 角度随时间线性漂移 | 上电静态标定、温度补偿 |
| 零偏不稳定性 | 0.01 ~ 0.1 °/s | 低频漂移，难以消除 | 与加速度计/磁力计融合 |
| 随机游走 | 0.1 ~ 1 °/√h | 角度随机波动 | 低通滤波、卡尔曼滤波 |
| 尺度因子误差 | 0.1% ~ 1% | 角速度比例偏差 | 转台标定 |
3.3 磁力计：地磁矢量与航向参考
磁力计用于测量周围磁场强度，在IMU系统中主要用来提供绝对航向参考（Yaw角）。地球表面存在稳定的地磁场，磁力线从南磁极指向北磁极。在无磁干扰环境下，磁力计三轴输出可以表示为地磁场矢量在载体坐标系下的投影。通过计算水平面内磁场分量的方向，即可得到载体相对于磁北的航向角。
磁力计的工作原理主要有三种：霍尔效应、磁阻效应和磁通门。消费级IMU中常用各向异性磁阻（AMR）传感器，其内部由坡莫合金薄膜构成，外部磁场变化会导致薄膜电阻值改变，通过惠斯通电桥转换为电压输出。磁力计的测量模型为：
m_b = R_bi · m_i + b_hard + b_soft + n_m其中，m_b 是载体坐标系下的磁场测量值，R_bi 是从惯性系到载体系的旋转矩阵，b_hard 是硬磁干扰（由铁磁性材料产生，表现为固定偏置），b_soft 是软磁干扰（由可磁化材料产生，表现为尺度与旋转变化），n_m 是测量噪声。
3.4 三传感器互补特性与融合逻辑
三类传感器在频域上具有天然的互补特性：
- 加速度计：低频特性好，静态时能准确测量重力方向，但动态时受运动加速度干扰，高频噪声大。
- 陀螺仪：高频特性好，动态响应快，短时间积分精度高，但低频漂移严重。
- 磁力计：提供绝对航向参考，无累积误差，但易受环境干扰且动态响应慢。
因此，实用的姿态解算系统必须采用融合策略：利用陀螺仪的短时精度进行姿态预测，利用加速度计和磁力计的长期稳定性进行校正。互补滤波器的核心思想是：
姿态估计 = 高通滤波(陀螺仪积分) + 低通滤波(加速度计/磁力计解算)而卡尔曼滤波则通过建立状态空间模型，将陀螺仪作为控制输入，加速度计和磁力计作为观测向量，在统计最优框架下估计姿态角与陀螺零偏。
3.5 实战案例：消费级IMU的静态与动态标定流程
以某型号六轴IMU（ICM-42688-P）为例，其加速度计量程设为 ±8g，陀螺仪量程设为 ±2000°/s，输出频率 1kHz。在实际工程中，我们按以下流程进行标定与验证：
- 静态采集：将IMU水平静止放置于无振动桌面，采集 5 分钟数据（300,000 个样本）。计算加速度计三轴均值，理想情况下应为 [0, 0, 1]g（Z轴向上）。实际测得 [0.012, -0.008, 0.998]g，说明存在零偏与尺度误差。
- 六位置标定：依次将IMU的 +X、-X、+Y、-Y、+Z、-Z 轴朝上，每个位置静止采集 30 秒。利用最小二乘法求解加速度计的零偏、尺度因子和轴间非正交矩阵。
- 陀螺仪零偏采集：IMU静止时，陀螺仪理论输出应为 0°/s。采集 1 分钟数据取平均，得到三轴零偏：X=0.35°/s，Y=-0.21°/s，Z=0.08°/s。该零偏在后续算法中必须扣除。
- 磁力计椭球拟合：将IMU在空间中缓慢旋转，采集 200 个以上不同姿态的磁场数据。理想情况下，三轴磁场数据应分布在一个球面上，但实际因硬磁和软磁干扰会形成椭球。通过最小二乘椭球拟合，得到 3×3 软磁校正矩阵和 3×1 硬磁偏置向量。
3.6 常见误区与工程复盘
在实际项目开发中，工程师常犯以下错误：
- 误区一：认为加速度计可以直接输出姿态角。实际上，加速度计输出的是比力，包含运动加速度分量，直接计算倾角在动态场景下会产生严重误差。
- 误区二：忽略陀螺仪零偏的温度依赖性。许多消费级陀螺仪的零偏随温度变化可达 ±1°/s，若不做温度补偿，长时间工作后姿态漂移会非常明显。
- 误区三：磁力计不做校准直接使用。未校准的磁力计航向误差可达 10°~30°，且在不同方向误差不一致。
- 误区四：采样率与滤波截止频率不匹配。陀螺仪积分需要较高的采样率（至少 100Hz），而加速度计低通滤波截止频率通常设为 5~20Hz，若采样率过低会导致混叠效应。