3. 惯性测量单元基础

在无人机VIO(Visual-Inertial Odometry)系统中,惯性测量单元(IMU)是唯一能够提供高频、短时高精度运动信息的传感器。视觉提供绝对尺度与长期约束,而IMU提供高频的角速度与线加速度,两者互补才能实现鲁棒的状态估计。理解IMU的物理原理与误差特性,是后续预积分、外参标定、时间同步与融合滤波的前提。

一、加速度计与陀螺仪的工作原理

MEMS加速度计通常采用梳齿电容结构:质量块在加速度作用下产生位移,差分电容变化被转换为电压信号,再经ADC采样输出比力(specific force)。注意加速度计测量的是“比力”而非纯加速度,静止水平放置时输出约为 +g(指向天),自由落体时输出接近 0。这一特性在VIO初始化中用于重力方向对齐。

MEMS陀螺仪基于科里奥利力原理:驱动质量块做高频振动,当存在角速度时,正交方向产生科里奥利位移,通过电容检测得到角速度。陀螺仪输出的是机体角速度 ω,单位通常为 rad/s 或 deg/s。陀螺仪对振动和温度非常敏感,是IMU误差的主要来源之一。

核心结论:加速度计测“比力”,陀螺仪测“角速度”。VIO中IMU预积分正是对这两类量在时间上的积分,因此任何零偏、噪声、尺度误差都会随积分时间累积。

二、IMU误差模型与关键参数

工程上常将IMU误差分为确定性误差与随机误差两类。确定性误差可通过标定补偿,随机误差只能通过滤波建模。

误差类型物理含义典型量级处理方式
零偏 b静止时非零输出陀螺 0.01–1 °/s标定+在线估计
噪声密度 σ白噪声强度陀螺 0.001–0.01 °/s/√Hz滤波噪声阵
随机游走零偏随时间漂移陀螺 0.0001–0.001 °/s²/√Hz零偏随机游走模型
尺度因子 s输出与真值比例误差0.1%–2%转台标定
轴间非正交三轴不正交耦合0.01–0.5°矩阵标定
温度漂移零偏随温度变化0.01–0.1 °/s/℃温补模型

完整的IMU误差模型可写为:

a_m = (I + S_a + M_a) * a_true + b_a + n_a
ω_m = (I + S_g + M_g) * ω_true + b_g + n_g
b_a(t) = b_a0 + w_ba(t)   // 零偏随机游走
b_g(t) = b_g0 + w_bg(t)

其中 S 为尺度因子矩阵,M 为非正交矩阵,n 为白噪声,w 为零偏随机游走。VIO中通常只在线估计 b_a、b_g,其余在出厂或离线标定中补偿。

三、标定方法与流程

IMU标定分为静态标定与动态标定。静态标定利用重力矢量在多姿态下的投影求解加速度计的零偏、尺度与安装矩阵;动态标定利用转台提供已知角速度激励,求解陀螺仪的零偏、尺度与非正交。温度标定则在温箱中采集不同温度下的零偏,拟合温补曲线。

  1. 将IMU固定在六面体工装上,依次采集 ±X、±Y、±Z 六个面的静止数据。
  2. 对每面数据取均值,构建重力观测方程,最小二乘求解加速度计参数。
  3. 将IMU安装于转台,按设定角速度序列旋转,采集陀螺仪输出。
  4. 以转台角速度为真值,拟合零偏、尺度与轴间耦合。
  5. 在温箱中重复上述过程,建立零偏-温度查找表或多项式模型。
实操建议:标定前先让IMU预热10–20分钟,待温度稳定后再采集数据;采集时避免桌面振动和气流扰动,否则零偏估计会被低频噪声污染。

四、典型场景与常见误区

以某消费级IMU(陀螺零偏 0.05 °/s,随机游走 0.0005 °/s²/√Hz)为例,若不做零偏估计,仅10秒积分就会产生约 0.5° 的姿态漂移;若随机游走未建模,长时间VIO会出现缓慢的航向偏移。因此在VIO中,IMU零偏必须作为状态量在线估计,且噪声阵要与数据手册一致。

常见误区包括:把加速度计静止输出当作“零”;忽略尺度因子导致大角速度下姿态误差;用同一组噪声参数应对所有温度;标定后不做验证直接上线。建议每次标定后用Allan方差曲线检查噪声与随机游走是否与手册吻合。

IMU误差模型与标定信号链 物理激励 重力 / 角速度 / 温度 MEMS敏感元件 加速度计 / 陀螺仪 误差注入 零偏·噪声·尺度·温漂 IMU原始输出 a_m , ω_m 标定流程 六面静态采集 加速度计参数 转台动态激励 陀螺仪参数 温箱温度扫描 温漂模型 Allan方差验证 噪声/随机游走 确定性误差补偿 a_c = (I+S+M)⁻¹ (a_m − b_a) ω_c = (I+S+M)⁻¹ (ω_m − b_g) 离线标定参数写入固件 随机误差在线估计 状态量:b_a , b_g 噪声阵:σ_a , σ_g , σ_ba , σ_bg VIO预积分与滤波联合优化 标定质量直接决定VIO初始化速度与长期漂移水平

综上,IMU的物理原理决定了其误差不可避免,但通过合理的误差建模与标定流程,可以将确定性误差补偿到很小,并将随机误差交由VIO滤波器在线估计。掌握零偏、噪声、随机游走、尺度因子与温度漂移这五个核心概念,是后续IMU预积分与视觉惯性联合优化的基础。