2、IMU硬件基础:加速度计、陀螺仪、磁力计的物理原理、输出模型与误差特性
惯性测量单元(IMU)是姿态估计、导航与组合定位系统的核心前端,其硬件特性直接决定了上层算法的性能上限。本章聚焦三类核心传感器——加速度计、陀螺仪、磁力计,从物理原理出发,建立各自的理想输出模型,再系统梳理误差来源与工程特性。理解这些基础,是后续开展 Allan 方差分析、六面标定、温度补偿和现场校准的前提。
2.1 加速度计:物理原理与输出模型
加速度计测量的是载体沿敏感轴方向的比力(Specific Force),即物体受到的惯性力与重力之差。MEMS 加速度计内部包含一个由硅微机械加工而成的敏感质量块,质量块通过弹性梁悬挂在固定电极之间。当载体加速运动时,质量块因惯性产生位移,导致差分电容发生变化,通过 ASIC 读取电容差值即可反推加速度大小。
理想情况下,三轴加速度计的输出模型为:
a_meas = a_true - g + n_a
其中 a_true 为载体的真实线加速度,g 为当地重力矢量(约 9.7803 m/s² 至 9.8322 m/s²,随纬度变化),n_a 为测量噪声。静止时,加速度计输出的是重力矢量在载体坐标系下的投影,因此可用于计算横滚角与俯仰角。
加速度计误差来源与特性
| 误差类型 | 典型量级 | 对姿态的影响 | 标定方法 |
|---|---|---|---|
| 零偏(Bias) | ±50 mg ~ ±200 mg | 横滚/俯仰角度偏移 | 六面静态标定 |
| 比例因子误差 | 0.5% ~ 2% | 加速度幅值失真 | 多位置最小二乘 |
| 交叉耦合 | 0.1% ~ 1% | 轴间串扰 | 矩阵求逆补偿 |
| 非线性度 | 0.1% ~ 0.5% FS | 大加速度下偏差 | 多项式拟合 |
| 温度漂移 | 0.1 ~ 1 mg/°C | 温变环境姿态漂移 | 温补表/多项式 |
加速度计的随机噪声通常用速度随机游走(VRW, Velocity Random Walk)描述,单位为 m/s/√h。VRW 越大,静态下加速度输出的抖动越明显,直接影响姿态解算的平稳性。
2.2 陀螺仪:哥氏力原理与积分特性
MEMS 陀螺仪基于哥氏效应(Coriolis Effect)工作。陀螺仪内部有一个质量块被驱动以固定频率沿某一轴做高频振动(驱动轴),当载体绕垂直于振动方向的轴旋转时,质量块会受到哥氏力,该力使质量块在检测轴方向产生位移,通过电容检测即可得到角速度。振动式陀螺仪的核心优势在于:角速度信号被调制到驱动频率上,可有效抑制低频噪声和温漂。
理想输出模型为:
ω_meas = ω_true + b_g + n_g
其中 b_g 为陀螺零偏(单位 °/s 或 rad/s),n_g 为角度随机游走噪声。陀螺仪输出的是角速度,需要积分才能得到姿态角增量。积分过程会累积零偏误差,导致姿态漂移随时间线性增长。
陀螺仪误差特性与 Allan 方差
陀螺仪的随机误差包含多个层次:角度随机游走(ARW)、零偏不稳定性(Bias Instability)、速率随机游走(RRW)、量化噪声等。Allan 方差是分析这些误差分量的标准工具,通过对静态数据做不同积分时间的方差分析,可在双对数坐标中识别各误差段的斜率特征。
- 角度随机游走(ARW):斜率 -1/2,对应白噪声角速度,单位 °/√h。
- 零偏不稳定性:曲线最低点,对应 1/f 噪声,是衡量陀螺仪长期稳定性的关键指标。
- 速率随机游走(RRW):斜率 +1/2,反映零偏的慢变漂移。
- 量化噪声:斜率 -1,由 ADC 分辨率限制引起。
Allan 方差分析结果可直接用于卡尔曼滤波器的噪声参数设置,是 IMU 选型和标定验证的重要依据。
2.3 磁力计:地磁测量与航向解算
磁力计用于测量载体所在位置的磁场矢量,在姿态解算中提供航向参考。常见的 MEMS 磁力计采用各向异性磁阻(AMR)或巨磁阻(GMR)效应,通过磁场引起敏感元件电阻变化来检测磁场强度。三轴磁力计可输出载体坐标系下的磁场三分量,结合加速度计确定的水平姿态,即可解算磁航向角。
理想输出模型为:
B_meas = R · B_earth + b_m + n_m
其中 R 为姿态旋转矩阵,B_earth 为当地地磁矢量,b_m 为磁力计零偏,n_m 为测量噪声。地磁矢量包含水平分量(指向磁北)和垂直分量(指向地心),其倾角随纬度变化。
磁力计误差来源与校准策略
| 误差类型 | 物理来源 | 表现特征 | 校准手段 |
|---|---|---|---|
| 硬铁干扰 | 固定磁化材料 | 球心偏移 | 零偏补偿 |
| 软铁干扰 | 可磁化材料 | 球体变椭球 | 3×3 矩阵补偿 |
| 比例因子误差 | 制造公差 | 各轴灵敏度不一致 | 归一化标定 |
| 非正交误差 | 安装偏差 | 轴间耦合 | 正交化矩阵 |
| 温度漂移 | 磁阻温度系数 | 输出随温度变化 | 温补表 |
磁力计校准的完整流程包括:采集多姿态数据(至少覆盖球面均匀分布)、计算椭球拟合参数、验证残差、在目标环境中进行航向精度测试。校准后的磁航向精度通常可达 ±1°~±3°(在无强磁干扰环境下)。
2.4 三传感器协同与误差耦合
实际 IMU 系统中,三个传感器并非独立工作,而是通过融合算法相互校正:陀螺仪提供短时高精度的角速度积分,加速度计提供长期稳定的水平参考,磁力计提供航向约束。三者特性互补,但也存在耦合误差——例如加速度计的振动噪声会通过姿态解算污染磁力计的倾角补偿,进而影响航向精度。
在硬件设计层面,还需关注以下工程细节:
- 采样同步:三轴传感器需同步采样,避免时间偏差导致融合误差。
- 抗混叠滤波:加速度计和陀螺仪输出需经过低通滤波,截止频率通常设为 50~200 Hz,以抑制机械振动和电气噪声。
- 电源去耦:IMU 的模拟电源(AVDD)和数字电源(DVDD)需分别去耦,典型值为 100nF + 4.7µF 组合,避免电源纹波耦合到敏感检测电路。
- 温度管理:IMU 芯片应远离发热源(如处理器、功率放大器),必要时增加散热焊盘或隔热设计。
2.5 常见误区与总结
在 IMU 硬件使用与标定中,工程师常陷入以下误区:
- 忽略温度影响:只在常温下标定,未做温度补偿,导致温变环境下精度急剧下降。
- 混淆零偏与噪声:零偏是确定性误差,可通过标定去除;噪声是随机误差,只能通过滤波抑制。两者需分别处理。
- 磁力计校准不充分:只在水平面旋转采集数据,未覆盖三维空间,导致椭球拟合不完整。
- 忽视安装误差:传感器与载体坐标系之间的安装偏差(非正交、旋转)未纳入标定模型,导致动态精度受限。
- 采样率与滤波不匹配:低采样率配合高截止频率滤波器,导致信号混叠。