4. IMU工作原理

IMU(Inertial Measurement Unit,惯性测量单元)是融合定位系统中负责“短时高频推算”的核心传感器。它通常由三轴加速度计、三轴陀螺仪,以及可选的三轴磁力计组成。GNSS 提供长期绝对位置,但更新率低、易受遮挡;IMU 提供高频相对运动信息,但会随时间漂移。理解三者的工作机理、误差模型与输出特性,是后续做松耦合、紧耦合乃至组合导航滤波的前提。

核心结论:加速度计测“比力”,陀螺仪测“角速度”,磁力计测“地磁方向”。三者互补,但都不能直接给出位置;必须通过积分、姿态解算与误差补偿,才能转化为可用的导航状态。

一、三轴传感器的工作机理

加速度计基于牛顿第二定律工作。以常见的 MEMS 电容式加速度计为例,内部有一个可动质量块,当载体产生加速度时,质量块因惯性发生位移,电容极板间距变化,从而输出与比力成正比的电压或数字量。需要特别注意的是,加速度计测量的是“比力”而非纯运动加速度:静止水平放置时,Z 轴输出约为 +1g,这来自重力反作用力。因此,在导航解算中必须先从比力中扣除重力,才能得到载体的运动加速度。

陀螺仪测量载体绕三轴的角速度。MEMS 陀螺仪多采用科里奥利力原理:驱动质量块在平面内高频振动,当载体发生旋转时,科里奥利力使质量块在正交方向产生位移,该位移被电容或压电方式检测,进而换算出角速度。陀螺仪输出的是角速度,积分一次得到角度变化,积分两次可参与位置推算。由于积分会累积误差,陀螺仪的零偏和随机游走是姿态发散的主要来源。

磁力计通过磁阻或霍尔效应测量地磁场在三轴上的分量。它相当于一个“电子罗盘”,可提供绝对航向参考,弥补陀螺仪航向漂移。但磁力计极易受电机、金属结构、电流线缆等硬磁和软磁干扰,因此工程上必须做椭球拟合校准和实时磁干扰检测。

IMU 三轴传感器:机理 → 输出 → 误差 → 融合 加速度计 机理:惯性质量块位移 输出:比力 a (m/s²) 误差:零偏、标度因数、噪声 特性:低频稳定,含重力分量 陀螺仪 机理:科里奥利力检测 输出:角速度 ω (°/s) 误差:零偏、随机游走、温漂 特性:高频响应好,积分漂移 磁力计 机理:磁阻/霍尔效应 输出:磁场强度 (μT) 误差:硬磁、软磁、倾斜误差 特性:绝对航向,易受干扰 姿态解算与误差补偿 互补滤波 / 卡尔曼滤波 / 椭球校准 输出:姿态、速度、位置增量 三轴正交安装,共同构成载体坐标系下的惯性测量基准

二、误差模型:从确定性误差到随机误差

IMU 误差可分为确定性误差和随机误差两大类。确定性误差可通过标定补偿,随机误差只能通过滤波建模抑制。

传感器 误差类型 典型表现 补偿手段
加速度计 零偏、标度因数、非正交 静止时输出不为 0 或 1g 六面法标定、最小二乘拟合
陀螺仪 零偏、随机游走、温漂 静止积分角度缓慢漂移 零偏估计、Allan 方差建模
磁力计 硬磁、软磁、倾斜误差 航向跳变、椭球畸变 椭球拟合、倾斜补偿
三者共同 轴间非正交、安装误差 三轴耦合、姿态解算偏差 联合标定、旋转矩阵校正

以陀螺仪为例,其输出可建模为:

ω_meas = ω_true + b_g + S_g · ω_true + N_g · ω_true + n_g

其中:
  b_g     陀螺零偏(°/s)
  S_g     标度因数误差矩阵
  N_g     非正交耦合矩阵
  n_g     高斯白噪声

加速度计模型类似,但需额外考虑重力分量。磁力计则常用椭球模型描述硬磁和软磁干扰。工程上,Allan 方差是分析随机误差的常用工具,可分离量化噪声、角度随机游走、零偏不稳定性等项。

三、输出特性与工程选型

不同应用场景对 IMU 的输出特性要求差异很大。消费级 MEMS 成本低、体积小,但零偏大、噪声高;工业级和战术级 IMU 零偏更小、稳定性更好,但价格显著上升。选型时需重点关注以下参数:

  • 零偏稳定性:决定姿态发散速度,单位通常为 °/h 或 °/s。
  • 角度随机游走:反映陀螺噪声水平,影响短时姿态精度。
  • 加速度计零偏:影响速度推算,单位 mg。
  • 输出频率:常见 100 Hz~1000 Hz,需与 GNSS 更新率匹配。
  • 量程:需覆盖载体最大角速度和加速度,避免饱和。
实操建议:在融合定位中,IMU 输出频率通常远高于 GNSS。建议将 IMU 数据缓存并做时间戳对齐,再送入滤波器;否则高频惯性信息会被低频 GNSS 拖慢,失去短时推算优势。

四、案例与常见误区复盘

某园区低速无人车项目曾出现“GNSS 失锁 3 秒后位置跳变”的问题。排查发现,陀螺仪零偏未做温度补偿,车辆在阳光下暴晒后零偏漂移明显,导致航向角在失锁期间快速发散。加入零偏在线估计和温度补偿后,失锁 5 秒内的位置误差从 2.3 米降至 0.6 米。

另一个常见误区是“磁力计校准一次就永久有效”。实际上,车辆装载金属货物、经过地下车库或靠近高压线时,磁环境会显著变化。正确做法是:定期做椭球拟合校准,并在融合中引入磁干扰检测,当磁场强度偏离正常范围时自动降低磁力计权重。

注意:加速度计在剧烈振动下会产生高频噪声,直接积分会迅速发散。工程上应先做低通滤波或振动补偿,再参与姿态解算。切勿把原始加速度计输出直接当作运动加速度使用。

总结来看,加速度计、陀螺仪和磁力计各自提供不同频段、不同性质的观测信息。加速度计和磁力计提供绝对参考,陀螺仪提供高频相对变化。只有建立准确的误差模型,并在融合滤波中合理分配权重,才能让 IMU 在 GNSS 失锁、多路径和遮挡场景下真正发挥“短时高精度推算”的价值。