2. IMU基础

IMU（Inertial Measurement Unit，惯性测量单元）是高动态场景下姿态解算与运动估计的核心传感器。它通常由三轴加速度计与三轴陀螺仪组成，分别测量比力与角速度。理解这两类敏感器件的物理机理、关键指标以及从敏感元件到数字输出的完整信号链，是后续进行量程选择、噪声建模与滤波器设计的前提。

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

MEMS加速度计的主流结构是电容式差分检测。质量块通过弹性梁悬置于基板之上，当存在加速度时，惯性力使质量块发生位移，差分电容随之改变，经调制解调后转换为与加速度成正比的电压。其测量本质是“比力”，即包含重力在内的非引力合力，因此静止水平放置时Z轴读数约为1g，这一点在姿态解算中必须显式扣除重力分量。

MEMS陀螺仪则基于科里奥利效应。驱动梳齿使质量块在驱动轴上以固定频率振动，当器件绕敏感轴旋转时，科里奥利力使质量块在检测轴上产生位移，位移幅度与角速度成正比。陀螺仪输出的是角速度而非角度，角度需通过积分获得，因此零偏与噪声会随时间累积成角度漂移。

二、关键性能指标

选型与设计时，以下指标直接决定系统在高动态条件下的可用性：

• 量程（Range）：可线性测量的最大输入，加速度计常用±2g～±16g，陀螺仪常用±250°/s～±2000°/s。量程越大，分辨率通常越差。
• 零偏（Bias）：输入为零时的输出，陀螺零偏直接导致角度漂移，单位常用°/s或°/h。
• 噪声密度：加速度计常用μg/√Hz，陀螺仪常用°/s/√Hz，决定积分后的随机游走。
• 非线性与交叉轴灵敏度：反映输出与真实输入的偏离程度及轴间耦合。
• 带宽与群延迟：影响对高频动态的响应能力与相位滞后。
• 零偏温漂：温度变化引起的零偏偏移，是高精度应用的主要误差源。

三、坐标系与信号链概述

IMU涉及三套坐标系：传感器本体坐标系（体轴）、载体坐标系与导航坐标系（如ENU/NED）。加速度计与陀螺仪的三轴应严格正交，但实际存在安装误差与轴间非正交，需通过标定矩阵修正。姿态解算的本质，就是把体轴下的测量值旋转到导航系下进行积分与融合。

从物理量到可用数据，IMU内部经历一条完整信号链：敏感元件→差分电容/电荷→前置放大→调制解调→低通滤波→ADC采样→数字滤波与温度补偿→寄存器输出。其中低通滤波决定带宽，ADC位数与采样率决定量化噪声，温度补偿决定零偏稳定性。任何一级设计不当，都会在高动态下表现为饱和、混叠或漂移。

四、典型场景与常见误区

以无人机高速机动为例：机体在急转弯时角速度可达数百°/s，若陀螺量程仅±250°/s，输出会削顶饱和，姿态解算瞬间失效；同时加速度计在振动环境下会引入高频噪声，若低通截止频率设置过高，噪声进入积分环节，姿态抖动明显。因此高动态IMU设计需要在量程、噪声与带宽之间做权衡。

# 典型IMU初始化参数示例
accel_range   = 8g        # 加速度计量程
gyro_range    = 1000dps   # 陀螺仪量程
accel_odr     = 1000Hz    # 加速度计输出速率
gyro_odr      = 1000Hz    # 陀螺仪输出速率
lpf_cutoff    = 100Hz     # 低通截止频率
temp_comp     = enabled   # 温度补偿使能

综上，加速度计与陀螺仪在原理上互补，在指标上互相制约。只有把工作原理、关键指标、坐标系变换与信号链各环节统一理解，才能在高动态场景下做出合理的量程与噪声设计，为后续的标定、滤波与融合打下基础。