2. 惯性传感器基础

惯性传感器是姿态解算系统的“感知末梢”,其输出质量直接决定了后续卡尔曼滤波的收敛速度与稳态精度。本章聚焦加速度计与陀螺仪两大核心器件,从物理原理出发,厘清它们的输出特性、误差模型与工程选型要点。理解这些基础,是后续设计融合算法、调试滤波参数的前提——因为任何滤波器都无法消除传感器本身引入的系统性偏差,只能通过建模来估计并补偿。

惯性传感器核心链路与误差注入点 物理激励 角速度 ω / 加速度 a (载体运动输入) 敏感结构 加速度计:质量块+悬臂梁 陀螺仪:谐振质量+科里奥利 电容/压阻检测 信号调理 C/V 转换 放大 / 滤波 ADC 采样 数字输出 SPI/I2C 16-bit ±2g~±16g 误差注入点(建模与补偿对象) 确定性误差 零偏 / 标度因数 安装失准角 随机误差 角度随机游走 零偏不稳定性 环境敏感 温度漂移 振动整流 / g-灵敏度 加速度计 vs 陀螺仪:互补特性 加速度计:低频准确,高频噪声大 静态测重力方向 → 俯仰/横滚基准 陀螺仪:高频准确,低频漂移大 角速度积分 → 短时姿态跟踪

2.1 加速度计:从质量块到倾角测量的物理映射

加速度计的核心是一个弹簧-质量-阻尼系统。当载体沿敏感轴方向加速时,质量块因惯性产生相对位移,该位移通过电容极板间距变化或压阻效应转换为电信号。在静止或匀速状态下,加速度计测量的实际上是重力加速度在敏感轴上的分量——这正是利用加速度计计算俯仰角和横滚角的物理基础。

以三轴加速度计为例,设重力加速度为 g,载体静止时三轴输出为 (ax, ay, az),则俯仰角 θ 和横滚角 φ 可由下式求得:

θ = atan2(a_x, sqrt(a_y² + a_z²))
φ = atan2(a_y, sqrt(a_x² + a_z²))

需要注意的是,该公式仅在载体无平动加速度时成立。一旦载体发生线性加速(如车辆起步、无人机急飞),加速度计输出将混入运动加速度,导致倾角计算严重失真。这是后续融合算法中需要利用陀螺仪进行补偿的核心原因。

工程经验:选型时关注加速度计的 量程 与 带宽。无人机通常选 ±4g~±8g,车载惯导选 ±16g;带宽建议设为姿态控制带宽的 5~10 倍,过高会引入高频噪声,过低会滞后真实运动。

2.2 陀螺仪:科里奥利效应与角速度积分

MEMS 陀螺仪利用科里奥利力测量角速度。内部质量块被驱动以固定频率振动,当载体绕敏感轴旋转时,质量块受到与振动方向垂直的科里奥利力,该力使检测梳齿产生位移,通过电容检测即可得到角速度。陀螺仪输出的是角速度(°/s),姿态角需通过积分获得:

θ(t) = θ(0) + ∫₀ᵗ ω(τ) dτ

积分过程会累积零偏误差。假设陀螺仪零偏为 0.1°/s,积分 60 秒后姿态误差将达 6°——这解释了为何纯陀螺仪积分无法长时间维持姿态精度。陀螺仪的误差模型通常包含:

  • 常值零偏(Bias):上电后相对固定的偏移,可通过静止校准扣除。
  • 零偏不稳定性(Bias Instability):随温度和时间缓慢漂移,是 Allan 方差分析中的关键指标。
  • 角度随机游走(ARW):白噪声积分后形成的角度随机误差,单位通常为 °/√h。
  • 标度因数误差:实际输出与理想比例之间的偏差,典型值在 0.1%~1% 之间。

2.3 误差来源与标定补偿策略

惯性传感器的误差可分为确定性误差和随机误差两大类。确定性误差可通过实验室标定消除,随机误差则需要通过滤波算法(如卡尔曼滤波)进行状态估计。下表总结了主要误差源及其工程应对方法:

误差类型 典型量级 对姿态解算的影响 补偿方法
加速度计零偏 ±50 mg 静态倾角误差约 ±3° 六位置静态标定
加速度计标度因数 0.5%~1% 动态加速度测量偏差 多位置最小二乘拟合
陀螺仪零偏 ±0.5°/s 积分后姿态漂移 静止采集求均值
陀螺仪零偏不稳定性 5~20°/h 长时间漂移累积 温度补偿 + 滤波估计
安装失准角 0.1°~1° 轴间耦合误差 六面转台标定
温度漂移 零偏变化 ±0.1°/s 环境变化引起缓变误差 温补表 + 多项式拟合

2.4 实战案例:IMU 上电标定与 Allan 方差分析

某四旋翼飞控项目选用 BMI088 六轴 IMU,要求姿态解算在 10 分钟内漂移小于 2°。初始测试发现悬停 5 分钟后俯仰角漂移达 4.5°,远超指标。排查过程如下:

  1. 静态采集:将飞控固定于水平台面,以 200Hz 采样率采集 5 分钟陀螺仪数据。
  2. 初步分析:计算均值发现 Z 轴零偏为 0.35°/s,远超数据手册典型值 0.1°/s。
  3. Allan 方差分析:绘制双对数曲线,识别出零偏不稳定性约为 12°/h,角度随机游走为 0.08°/√h。
  4. 温度影响排查:用热风枪加热 IMU 区域,发现零偏随温度变化率约为 0.02°/s/℃。

最终采取三项措施:

  • 上电后静止 10 秒,采集 2000 个样本求平均作为零偏初值;
  • 在卡尔曼滤波状态向量中加入陀螺仪零偏状态量,实时估计并补偿;
  • 增加温度补偿表,以 5℃ 为间隔存储零偏修正值。

改进后,10 分钟悬停姿态漂移降至 1.2°,满足指标要求。该案例说明:传感器误差的工程处理不是“选贵器件”一劳永逸,而是“标定 + 建模 + 滤波”三位一体的系统设计。

常见误区:初学者常将加速度计和陀螺仪数据直接相加或简单加权平均,忽略了二者误差特性的频域互补性。正确做法是:低频段信任加速度计(重力基准),高频段信任陀螺仪(积分短时准确),通过互补滤波或卡尔曼滤波实现频域最优融合。

2.5 本章总结与选型复盘

加速度计与陀螺仪在物理原理、输出特性和误差模型上具有天然互补性。加速度计提供参考(重力方向),但易受运动加速度干扰;陀螺仪提供相对变化(角速度积分),但存在积分漂移。工程实践中,必须建立完整的误差预算表,明确各项误差对最终姿态精度的影响权重,再针对性地设计标定流程和滤波策略。

选型时建议关注以下关键参数:陀螺仪的零偏不稳定性(优于 10°/h)、加速度计的零偏稳定性(优于 1 mg)、以及两者的带宽和输出噪声密度。同时,务必为温度补偿预留软件接口——因为温度漂移往往是实际系统中最大的隐性误差源。