4. IMU工作原理
IMU(Inertial Measurement Unit,惯性测量单元)是融合定位系统中负责“短时高频推算”的核心传感器。它通常由三轴加速度计、三轴陀螺仪,以及可选的三轴磁力计组成。GNSS 提供长期绝对位置,但更新率低、易受遮挡;IMU 提供高频相对运动信息,但会随时间漂移。理解三者的工作机理、误差模型与输出特性,是后续做松耦合、紧耦合乃至组合导航滤波的前提。
一、三轴传感器的工作机理
加速度计基于牛顿第二定律工作。以常见的 MEMS 电容式加速度计为例,内部有一个可动质量块,当载体产生加速度时,质量块因惯性发生位移,电容极板间距变化,从而输出与比力成正比的电压或数字量。需要特别注意的是,加速度计测量的是“比力”而非纯运动加速度:静止水平放置时,Z 轴输出约为 +1g,这来自重力反作用力。因此,在导航解算中必须先从比力中扣除重力,才能得到载体的运动加速度。
陀螺仪测量载体绕三轴的角速度。MEMS 陀螺仪多采用科里奥利力原理:驱动质量块在平面内高频振动,当载体发生旋转时,科里奥利力使质量块在正交方向产生位移,该位移被电容或压电方式检测,进而换算出角速度。陀螺仪输出的是角速度,积分一次得到角度变化,积分两次可参与位置推算。由于积分会累积误差,陀螺仪的零偏和随机游走是姿态发散的主要来源。
磁力计通过磁阻或霍尔效应测量地磁场在三轴上的分量。它相当于一个“电子罗盘”,可提供绝对航向参考,弥补陀螺仪航向漂移。但磁力计极易受电机、金属结构、电流线缆等硬磁和软磁干扰,因此工程上必须做椭球拟合校准和实时磁干扰检测。
二、误差模型:从确定性误差到随机误差
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 更新率匹配。
- 量程:需覆盖载体最大角速度和加速度,避免饱和。
四、案例与常见误区复盘
某园区低速无人车项目曾出现“GNSS 失锁 3 秒后位置跳变”的问题。排查发现,陀螺仪零偏未做温度补偿,车辆在阳光下暴晒后零偏漂移明显,导致航向角在失锁期间快速发散。加入零偏在线估计和温度补偿后,失锁 5 秒内的位置误差从 2.3 米降至 0.6 米。
另一个常见误区是“磁力计校准一次就永久有效”。实际上,车辆装载金属货物、经过地下车库或靠近高压线时,磁环境会显著变化。正确做法是:定期做椭球拟合校准,并在融合中引入磁干扰检测,当磁场强度偏离正常范围时自动降低磁力计权重。
总结来看,加速度计、陀螺仪和磁力计各自提供不同频段、不同性质的观测信息。加速度计和磁力计提供绝对参考,陀螺仪提供高频相对变化。只有建立准确的误差模型,并在融合滤波中合理分配权重,才能让 IMU 在 GNSS 失锁、多路径和遮挡场景下真正发挥“短时高精度推算”的价值。