2、IMU基础原理：加速度计与陀螺仪的工作原理、测量模型、坐标系定义及误差来源

IMU（Inertial Measurement Unit，惯性测量单元）是惯性导航与组合导航系统的核心传感器组件，通常由三轴加速度计、三轴陀螺仪以及必要的信号调理电路组成。要完成标定工作，首先必须深刻理解这两类传感器在物理层面如何感知运动、其输出与真实物理量之间的数学关系、坐标系的约定方式，以及误差从何而来。只有将测量模型与误差机理梳理清楚，后续的六面静态标定、转台速率标定、温度补偿乃至多位置对准才有理论依据。本章将从工作原理、测量模型、坐标系定义和误差来源四个维度展开，为后续标定方法打下坚实基础。

上图展示了IMU从物理输入到数字输出的完整信号链路，以及标定需要关注的误差注入点。可以看到，真实物理量（比力和角速度）经过MEMS敏感元件、信号调理电路后转换为数字量，而零偏、比例因子、轴间耦合和随机噪声在链路的不同环节被引入。理解这条链路，是建立标定模型的前提。

2.1 加速度计工作原理与测量模型

2.1.1 核心原理：从质量块到电容检测

加速度计的本质是测量比力（Specific Force），而非直接测量运动加速度。MEMS加速度计通常采用差分电容式结构：一个微小的质量块通过硅悬臂梁悬挂在基板上，当载体加速时，质量块因惯性产生位移，导致两侧固定电极与可动电极之间的电容差发生变化。通过检测该差分电容值，即可反推质量块所受的惯性力，进而得到比力。值得注意的是，静止放置时加速度计输出约为1g（重力加速度），这是因为地面支撑力通过壳体传递给质量块，使其感受到向上的支撑力——这正是比力与重力加速度方向相反的原因。

2.1.2 测量模型：线性化误差方程

理想情况下，加速度计三轴输出与比力呈线性关系。实际工程中，考虑零偏、比例因子误差、轴间耦合和非线性项，加速度计的测量模型可表示为：

a_m = S_a · M_a · (a_true + b_a + n_a + ε_a)

其中：
a_m    —— 加速度计实际输出向量 (3×1)
a_true —— 真实比力向量 (3×1)
S_a    —— 比例因子对角矩阵 diag(s_ax, s_ay, s_az)
M_a    —— 轴间耦合矩阵（非对角元素为安装误差角）
b_a    —— 零偏向量 (3×1)
n_a    —— 随机噪声（速度随机游走 VRW）
ε_a    —— 非线性误差及温度漂移项

在标定实践中，通常将 S_a 与 M_a 合并为一个上三角矩阵 K_a（6个独立参数），加上零偏 b_a（3个参数），构成9参数标定模型。若考虑温度影响，还需增加温度系数项。下表给出了各误差参数的物理含义与典型量级：

2.1.3 案例拆解：静止放置时的加速度计输出分析

假设一个IMU水平放置在桌面上，Z轴朝上。理想情况下，三轴输出应为 [0, 0, 1g]。实际采集1000个样本后，得到均值 [0.012g, -0.008g, 0.985g]。分析过程如下：

1. 零偏判断：X轴0.012g、Y轴-0.008g的偏移即为零偏，Z轴0.985g与1g的差值-0.015g中既包含零偏也包含比例因子误差。
2. 比例因子估计：若已知零偏为[0.012, -0.008, -0.010]g，则Z轴比例因子误差约为 (0.985+0.010)/1.0 - 1 = -0.5%。
3. 轴间耦合判断：若翻转使X轴朝上，输出应为[1g, 0, 0]，但实际测得[0.995g, 0.010g, 0.005g]，说明Y轴对X轴存在约0.57°的耦合角。

这个案例说明，仅靠单次静态测量无法分离零偏和比例因子，必须通过多位置翻转建立方程组求解。

2.2 陀螺仪工作原理与测量模型

2.2.1 核心原理：科里奥利效应与振动环

MEMS陀螺仪基于科里奥利效应工作。一个质量块被驱动以固定频率沿驱动轴振动，当载体绕敏感轴旋转时，质量块受到科里奥利力作用，在检测轴方向产生与角速度成正比的位移。该位移通过电容检测转换为电信号。以振动环陀螺为例，驱动电极使环产生椭圆振动模态，旋转时科里奥利力耦合到检测模态，检测模态的振幅与角速度成正比。陀螺仪测量的是载体相对惯性空间的角速度，而非角加速度。

2.2.2 测量模型：含正交误差的完整表达

陀螺仪的测量模型与加速度计类似，但增加了正交误差项（g-sensitivity）和角速度随机游走（ARW）。工程上常用的模型为：

ω_m = S_g · M_g · (ω_true + b_g + n_g + ε_g) + G_a · a_true

其中：
ω_m    —— 陀螺仪输出向量 (3×1)
ω_true —— 真实角速度向量 (3×1)
S_g    —— 比例因子矩阵
M_g    —— 轴间耦合矩阵（含正交误差）
b_g    —— 零偏（角速率偏移）
n_g    —— 角度随机游走噪声
G_a    —— 加速度敏感系数（g-sensitivity）
ε_g    —— 温度及非线性误差

g-sensitivity 表示陀螺仪对加速度的敏感程度，在振动环境下尤为明显。例如，某陀螺的 g-sensitivity 为 0.01°/s/g，当载体承受 5g 振动时，将产生 0.05°/s 的角速度误差，长时间积分将导致显著姿态漂移。

2.2.3 陀螺仪误差特性对比

2.3 坐标系定义与转换关系

2.3.1 载体坐标系与导航坐标系

IMU标定涉及三个层次的坐标系：传感器坐标系（s系，由MEMS芯片的物理敏感轴定义）、载体坐标系（b系，通常定义为前-右-下或右-前-上）、导航坐标系（n系，常用ENU或NED）。标定的核心任务之一，就是确定传感器坐标系到载体坐标系的安装转换矩阵。实际工程中，由于焊接、贴装误差，传感器敏感轴与载体轴之间存在小角度偏差，需要通过标定获取该安装矩阵。

2.3.2 坐标系转换的数学表达

设载体坐标系下的比力为 f_b，传感器坐标系下的测量值为 f_s，则转换关系为：

f_b = C_s^b · f_s

其中 C_s^b 为安装矩阵，可分解为三个欧拉角旋转：
C_s^b = Rz(ψ) · Ry(θ) · Rx(φ)

对于小角度安装误差（<1°），可近似为：
C_s^b ≈ [1   -ψ   θ;
          ψ    1   -φ;
         -θ   φ    1]

在标定模型中，安装矩阵的非对角元素即对应轴间耦合系数。例如，M_a 矩阵中的 M_xy 表示Y轴对X轴的耦合，其物理意义是传感器Y轴与载体X轴之间的安装偏差角。

2.4 误差来源综合分析

2.4.1 确定性误差与随机误差

IMU误差可分为两大类：确定性误差（可通过标定补偿）和随机误差（只能通过滤波抑制）。确定性误差包括零偏、比例因子误差、轴间耦合、温度漂移和非线性；随机误差包括角度随机游走（ARW）、速度随机游走（VRW）、零偏不稳定性（Bias Instability）和量化噪声。下表汇总了各类误差的典型特征：

2.4.2 温度对误差的影响机理

温度是影响MEMS传感器性能的最主要环境因素。硅材料的杨氏模量随温度变化约-30ppm/°C，导致悬臂梁刚度改变，进而影响比例因子；封装应力随温度释放导致零偏漂移；驱动电路增益变化也会引入误差。工程上通常采用多项式拟合或查表法进行温度补偿。例如，某加速度计零偏随温度变化曲线近似为二次函数：

b_a(T) = b_0 + b_1·(T - T_0) + b_2·(T - T_0)²

实测数据：
T_0 = 25°C, b_0 = 12.3 mg
b_1 = -0.08 mg/°C, b_2 = 0.0012 mg/°C²

在60°C时，零偏为：
b_a(60) = 12.3 - 0.08×35 + 0.0012×1225 = 12.3 - 2.8 + 1.47 = 10.97 mg

可见，温度从25°C升至60°C时，零偏变化约1.33mg，对于高精度应用不可忽略。

2.4.3 案例拆解：消费级IMU标定前后的性能对比

某无人机项目采用BMI088 IMU，标定前进行静态测试：将IMU水平放置，采集10分钟数据，计算姿态角漂移。标定前，俯仰角漂移约2.3°，横滚角漂移约1.8°。经六面静态标定（9参数模型）后，重新测试，俯仰角漂移降至0.3°，横滚角漂移降至0.2°。进一步进行转台速率标定（补偿比例因子和轴间耦合）后，航向角漂移从标定前的5.6°/min降至0.8°/min。该案例表明：

• 零偏补偿是姿态漂移的主要抑制手段，贡献约70%的改善量；
• 比例因子和轴间耦合补偿对航向角积分精度提升显著；
• 标定后残余漂移主要来自随机噪声和温度变化，需通过滤波和温控进一步抑制。

2.5 总结与标定前置准备

本章梳理了IMU的核心原理与误差体系。加速度计测量比力，陀螺仪测量角速度，两者均存在零偏、比例因子、轴间耦合、温度漂移和随机噪声等误差。坐标系定义（s系、b系、n系）是标定模型建立的基石，安装矩阵的确定是标定的重要输出之一。在进入具体标定方法之前，建议完成以下准备工作：

1. 确认IMU数据手册中的量程、分辨率、带宽和噪声密度参数；
2. 设计标定工装，确保IMU可精确安装到六个正交方向；
3. 准备数据采集软件，设置合理的采样率（通常≥100Hz）和采集时长（每位置≥60秒）；
4. 记录环境温度，若温度变化超过±2°C，需考虑温度补偿或等待热稳定。