4、IMU传感器模型与校准：加速度计、陀螺仪、磁力计的工作原理、误差模型、校准方法与面试问题
IMU（惯性测量单元）是飞控系统感知自身运动状态的核心传感器套件，通常包含三轴加速度计、三轴陀螺仪，以及可选的三轴磁力计。在飞控算法面试中，IMU相关题目几乎必考，但考察点往往不是“会用库函数读取数据”，而是对传感器物理原理、误差来源、校准方法以及数据融合前处理的深入理解。本章将从工作原理出发，系统梳理三类传感器的误差模型与校准流程，并结合面试常见追问给出实战拆解。
4.1 加速度计：比力测量与重力参考
加速度计测量的是载体受到的比力（Specific Force），即物体加速度与重力加速度的矢量差。在静止或匀速运动时，加速度计输出恰好等于重力加速度的反向矢量，因此它提供了的水平参考。但在动态飞行中，加速度计输出包含运动加速度，不能直接当作重力方向使用。
其误差模型可表示为：
a_meas = (I + S_a) · K_a · a_true + b_a + n_a其中 S_a 为非正交误差矩阵，K_a 为尺度因子对角阵，b_a 为零偏，n_a 为测量噪声。六位置静态校准法是最常用的方法：将IMU分别以六个正交方向静止放置，每个位置采集30秒以上数据，利用重力矢量模长恒为1g的约束，通过最小二乘求解12个参数（3个零偏、3个尺度、6个非正交项）。
4.2 陀螺仪：角速度测量与姿态积分
陀螺仪基于科里奥利效应（MEMS振动式）或Sagnac效应（光纤式）测量载体角速度。飞控中常用MEMS陀螺，其核心误差包括：常值零偏、温度漂移、角度随机游走（ARW）和速率随机游走（RRW）。陀螺仪积分得到姿态角，但零偏导致的姿态误差会随时间累积，因此需要加速度计和磁力计进行长期修正。
陀螺仪误差模型通常写作：
ω_meas = (I + S_g) · K_g · ω_true + b_g + b_g_temp(T) + n_g校准方法分为两步：静态零偏采集（静止放置1-2分钟取均值）和速率标定（使用转台提供已知角速度，拟合尺度因子和非正交项）。对于没有转台的场景，可采用“多位置静止法”估算零偏稳定性，但无法分离尺度误差。
4.3 磁力计：地磁矢量与航向参考
磁力计测量载体所在位置的磁场强度矢量。在地理坐标系中，地磁场方向指向磁北且与水平面存在磁倾角。磁力计提供航向参考，但极易受环境磁场干扰（电机电流、金属结构、高压线等）。其误差模型比加速度计更复杂：
m_meas = (I + S_m) · K_m · R · m_true + b_hard + b_soft + n_m其中 b_hard 为硬磁干扰（由铁磁性材料产生，表现为固定偏置），b_soft 为软磁干扰（由可磁化材料产生，表现为尺度与旋转耦合）。校准的核心是椭球拟合：在空间中旋转IMU，采集足够多的磁场样本，拟合三维椭球方程，将椭球中心偏移（硬磁）和轴长比例（软磁）补偿掉。
| 误差类型 | 物理来源 | 数学模型 | 校准方法 |
|---|---|---|---|
| 硬磁干扰 | 永磁体、直流电流 | 常数偏置向量 | 椭球中心偏移补偿 |
| 软磁干扰 | 铁磁材料感应 | 3×3对称矩阵 | 椭球轴长归一化 |
| 尺度因子 | 制造公差 | 对角阵 | 椭球半径归一化 |
| 非正交 | 安装误差 | 上三角矩阵 | 最小二乘拟合 |
4.4 校准流程与实战案例
完整的IMU校准流程分为四个阶段：数据采集、参数估计、补偿验证、参数固化。以下通过一个实际飞控调试案例说明。
案例背景：某四旋翼无人机在悬停时航向缓慢漂移，约每分钟偏转3°-5°，且飞行器在高速前进时姿态解算出现明显倾斜误差。初步排查发现，飞控中仅做了加速度计六位置校准和陀螺仪静态零偏扣除，未进行磁力计校准和陀螺仪温度补偿。
分析过程：航向漂移主要源于陀螺仪零偏未完全补偿（残留零偏约0.05°/s），以及磁力计硬磁干扰导致航向修正错误。高速前进时的倾斜误差则与加速度计尺度因子误差有关——在1.5g加速度下，1%的尺度误差会产生约0.86°的倾斜角误差。
操作步骤：
- 重新进行加速度计六位置校准，采集每个位置60秒数据，使用最小二乘求解12参数，残差从0.08g降至0.012g。
- 陀螺仪进行温度补偿：在室温25°C和45°C下分别采集零偏，建立线性插值表，零偏稳定性从0.05°/s提升至0.008°/s。
- 磁力计执行椭球拟合：手持无人机在空中画“8”字轨迹，采集2000个样本，计算椭球中心偏移（硬磁）和变换矩阵（软磁），补偿后磁场模长波动从±15%降至±2%。
- 验证：静止测试航向漂移降至0.2°/min以内；高速飞行（10m/s）时姿态误差小于1°。
4.5 常见误区与面试要点
面试中常见的误区包括：将加速度计输出直接当作重力方向（忽略运动加速度）；认为陀螺仪零偏是常数（实际随温度和时间漂移）；磁力计校准只做平面旋转（必须三维旋转）；忽略非正交误差（低端IMU中可达1°-2°）。
面试官常问的进阶问题包括：
- 如何区分陀螺仪零偏和加速度计噪声？——通过Allan方差分析，零偏表现为长时间段的斜率，噪声表现为短时间段的平坦区。
- 为什么磁力计在无人机内部需要远离电机？——电机电流产生磁场干扰，且随油门变化，无法通过静态校准消除。
- IMU校准后残差多大算合格？——加速度计残差应小于0.02g，陀螺仪零偏稳定性应优于0.01°/s，磁力计模长波动应小于3%。
总结而言，IMU校准是飞控算法的基础工程，面试中不仅考察校准方法，更关注候选人对误差模型的理解深度和工程判断力。掌握本章内容，能够应对从基础原理到实际调试的各类问题。