📚 课程目录第3章 IMU基础

3、IMU基础：加速度计与陀螺仪工作原理、误差模型与惯性导航解算

惯性测量单元（IMU）是组合导航系统的核心敏感器件，其性能直接决定了系统在GNSS信号中断时的姿态与位置保持能力。本章围绕IMU的三大核心问题展开：加速度计与陀螺仪如何感知物理运动、它们的误差如何建模与补偿、以及如何利用角增量和速度增量完成姿态、速度与位置的递推解算。理解这些基础是后续设计紧耦合滤波器、进行可观性分析的前提。

上图展示了IMU从物理敏感到导航解算的完整链路。左侧为加速度计与陀螺仪的敏感原理，中间为误差建模与标定环节，右侧为惯性导航解算流程，底部则揭示了误差传播的因果关系。下面我们逐层深入。

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

3.1.1 加速度计：比力测量原理

加速度计测量的是载体相对于惯性空间的比力（Specific Force），即单位质量上除引力以外的合力。其核心结构为一个敏感质量块，通过弹性约束或电磁力平衡悬挂在壳体内部。当载体加速运动时，质量块因惯性产生位移，检测电路将位移量转换为电容变化或电压信号，从而反演出比力大小。

在导航应用中，加速度计输出的是比力 f = a - g，其中 a 为载体的运动加速度，g 为重力加速度。这一关系至关重要：静止时加速度计输出约为 1g（向上），自由落体时输出为 0。因此，从加速度计读数中扣除重力分量后，才能得到真实的运动加速度。

类型	工作原理	典型精度	应用场景
MEMS 电容式	质量块位移改变电容	0.1~10 mg	消费电子、低成本组合导航
石英挠性	力平衡式，石英摆片	10~100 μg	战术级、航空导航
三浮/静电	静电悬浮或液浮支撑	<1 μg	战略级、高精度测量

3.1.2 陀螺仪：角速度敏感原理

陀螺仪用于测量载体相对于惯性空间的角速度 ω_ib^b（上标 b 表示载体坐标系）。MEMS 陀螺仪基于科里奥利效应：一个质量块在驱动轴方向做高频振动，当载体旋转时，科里奥利力使质量块在检测轴方向产生位移，位移大小与输入角速度成正比。

光纤陀螺（FOG）则利用萨格纳克效应，通过测量两束相向传播激光的相位差来获取角速度。激光陀螺（RLG）利用环形谐振腔中的驻波频率差。不同原理的陀螺在零偏稳定性、标度因数线性度、抗振动性能上差异显著，选型时需结合系统精度需求和成本约束。

工程经验：在紧耦合组合导航系统中，陀螺的零偏稳定性（Bias Stability）是最关键的指标。若陀螺零偏为 1°/h，则纯惯性导航 10 分钟后的姿态误差约为 0.17°，对应水平位置误差约 300m（受重力耦合放大）。因此，GNSS/IMU 紧耦合设计中，陀螺零偏通常要求优于 10°/h（MEMS 级）或 0.1°/h（战术级）。

3.2 IMU 误差模型与标定方法

3.2.1 确定性误差与随机误差

IMU 误差可分为确定性误差（可通过标定补偿）和随机误差（需在滤波器中建模）。确定性误差包括：常值偏置（Bias，陀螺单位 °/h，加速度计单位 mg）、比例因子（Scale Factor，单位 ppm）、安装误差（轴间非正交角，单位 μrad）。随机误差主要包括：角度随机游走（ARW，单位 °/√h）、速率随机游走（RRW）、零偏不稳定性（Bias Instability）。

完整的误差模型可表示为：

陀螺输出 = (1 + s_g) · ω_true + b_g + n_g + ε_g(t)
加速度计输出 = (1 + s_a) · f_true + b_a + n_a + ε_a(t)
其中：
  s_g, s_a —— 比例因子误差
  b_g, b_a —— 常值偏置（含温度漂移）
  n_g, n_a —— 白噪声（角度/速度随机游走）
  ε_g, ε_a —— 一阶马尔可夫过程（相关时间通常 100~1000s）

3.2.2 标定流程：六位置法与 Allan 方差

加速度计标定通常采用六位置法：将 IMU 分别以 ±X、±Y、±Z 六个方向朝上静置，记录各轴输出。由于每个位置的重力投影已知，可建立超定方程组求解偏置、比例因子和安装误差。陀螺标定则需要借助速率转台，在多个恒定角速率下采集输出，拟合比例因子和偏置。

随机误差参数通过Allan 方差分析获取：采集长时间静态数据（通常 2~4 小时），计算 Allan 标准差与平均时间的双对数曲线。曲线中斜率为 -1/2 的段对应角度随机游走，斜率为 0 的谷底对应零偏不稳定性，斜率为 +1/2 的段对应速率随机游走。

  标定案例：某 MEMS IMU 标定结果（温度 25°C 恒温）：
  加速度计零偏：X 轴 3.2 mg，Y 轴 -1.8 mg，Z 轴 5.6 mg
陀螺零偏：X 轴 12.5 °/h，Y 轴 -8.3 °/h，Z 轴 15.1 °/h
角度随机游走：0.35 °/√h
零偏不稳定性：8.2 °/h（Allan 方差谷底）

  该数据表明，陀螺零偏较大但随机游走尚可，适合中低精度组合导航。若用于紧耦合，需在状态向量中显式估计陀螺零偏，否则 10 分钟后位置误差将超过 500m。

常见误区：许多工程师只关注零偏和比例因子，忽略安装误差。实际上，1 mrad 的安装误差在 1g 重力作用下会产生约 1 mg 的等效加速度误差，在 100s 纯惯性导航中导致约 5m 的位置误差。对于高精度系统，必须进行完整的 12 参数标定（3 偏置 + 3 比例因子 + 6 安装误差）。

3.3 惯性导航解算：姿态、速度与位置更新

3.3.1 姿态更新：四元数与等效旋转矢量

姿态更新是惯导解算的核心。工程中常用四元数表示姿态，避免欧拉角的奇异性。陀螺输出的角增量 Δθ 用于构造姿态变化四元数：

q_{k+1} = q_k ⊗ q(Δθ)
其中 q(Δθ) = [cos(|Δθ|/2), (Δθ/|Δθ|)·sin(|Δθ|/2)]

在动态环境中，需进行圆锥补偿（Coning Compensation），因为角速度矢量方向在积分区间内会旋转，直接积分会引入不可交换误差。常用二子样或三子样算法：

Δθ_comp = Δθ_1 + Δθ_2 + (2/3)·(Δθ_1 × Δθ_2)
其中 Δθ_1, Δθ_2 为相邻两个半周期的角增量

3.3.2 速度与位置更新

速度更新基于比力方程：

v̇^n = C_b^n · f^b - (2ω_ie^n + ω_en^n) × v^n + g^n

其中 C_b^n 为姿态矩阵，f^b 为加速度计比力，ω_ie^n 为地球自转角速度，ω_en^n 为载体在地球表面运动引起的角速度，g^n 为重力矢量。实际计算中，需将加速度计输出的速度增量 Δv 投影到导航系，并扣除有害加速度（哥氏加速度和向心加速度）。

位置更新通过对速度积分获得，同时需考虑地球曲率半径：

L_{k+1} = L_k + v_N·Δt / (R_M + h)
λ_{k+1} = λ_k + v_E·Δt / ((R_N + h)·cos L)
h_{k+1} = h_k + v_U·Δt

其中 R_M 为子午圈曲率半径，R_N 为卯酉圈曲率半径。

更新项	输入	补偿项	典型频率
姿态	陀螺角增量	圆锥补偿、旋转矢量	100~1000 Hz
速度	加速度计速度增量	划桨补偿、哥氏修正	100~1000 Hz
位置	速度积分	曲率半径、高度修正	10~100 Hz

3.3.3 解算流程与工程实现

实际工程中，惯导解算通常以 200~500 Hz 的中断频率运行。每个周期内依次完成：读取陀螺和加速度计原始数据 → 误差补偿（扣除标定后的偏置、比例因子）→ 姿态更新 → 速度更新 → 位置更新。在紧耦合系统中，解算结果（姿态、速度、位置）作为滤波器状态预测值，而 GNSS 原始观测（伪距、载波相位）作为量测更新。

  实战场景：某车载组合导航系统采用 MEMS IMU（200 Hz 输出），GNSS 更新率 10 Hz。在 GNSS 信号遮挡的隧道场景中（约 90 秒），纯惯性解算的位置漂移为 85m。分析发现：主要误差源为陀螺零偏（约 20°/h）导致的姿态误差，进而使重力加速度投影到水平方向，产生等效水平加速度。通过在紧耦合滤波器中增加陀螺零偏状态估计，并将位置误差反馈修正，重新测试后隧道内漂移降至 32m，提升约 62%。

风险提示：惯性解算的数值积分必须使用双精度浮点，否则在长时间导航中会因舍入误差累积导致位置漂移。此外，高动态环境下（如无人机急转弯），需提高解算频率或采用更高阶的圆锥/划桨补偿算法，否则不可交换误差会显著增大。

3.3.4 常见误区与复盘

误区一：认为加速度计输出就是运动加速度。实际上输出的是比力，必须扣除重力分量。静止时加速度计读数约为 1g，而非 0。
误区二：忽略陀螺零偏的时变特性。常值偏置标定后仍有残余，且随温度漂移。紧耦合滤波器中必须将零偏作为状态量在线估计。
误区三：姿态更新频率不足。若陀螺输出频率低于 100 Hz，在振动环境下圆锥误差会急剧增大，导致姿态发散。
误区四：位置更新未考虑地球曲率。在长距离导航（>10 km）中，平面近似会导致数十米的误差。

总结而言，IMU 基础是组合导航系统的物理根基。加速度计和陀螺仪的工作原理决定了测量信息的物理含义，误差模型为滤波器的状态设计提供了依据，而惯性解算则是连接原始测量与导航参数的桥梁。在紧耦合系统设计中，这三者必须协同考虑：误差模型的准确性决定了滤波器性能的上限，解算算法的精度决定了系统在 GNSS 中断时的生存能力。下一阶段，我们将在此基础上讨论 GNSS 原始观测模型及其与 IMU 的紧耦合融合策略。