惯性测量单元基础：加速度计与陀螺仪的工作原理、输出特性、坐标系与单位

惯性测量单元（IMU，Inertial Measurement Unit）是姿态解算与运动追踪系统的物理基础。无论是手机屏幕旋转、无人机悬停，还是机器人行走平衡，其底层数据均来源于加速度计与陀螺仪这两个核心传感器。本章将深入剖析二者的物理工作原理、数字输出特性、工程坐标系定义以及单位换算关系，帮助你在后续滤波算法设计之前，建立对“原始数据”的准确认知。只有理解了传感器“为什么这样输出”以及“输出代表什么”，才能正确选择滤波策略并诊断数据异常。

上图展示了IMU数据链路的整体框架：加速度计与陀螺仪分别测量比力和角速度，在载体坐标系（b系）下输出原始数字量，最终通过量程、零偏和噪声密度等参数描述其性能边界。下面我们将逐一拆解每个环节的物理本质与工程含义。

2.1 加速度计工作原理与输出特性

2.1.1 核心原理：质量-弹簧-阻尼系统

微机电系统（MEMS）加速度计的核心是一个微小的质量块，通过弹性梁悬挂在硅片上。当传感器沿敏感轴方向加速时，质量块因惯性产生位移，该位移改变差分电容的间距，通过电容-电压转换电路输出与加速度成正比的电压信号。需要特别强调的是，加速度计测量的是比力（Specific Force），即物体所受非引力外力（如推力、摩擦力）与质量的比值，而非重力本身。当传感器静止放置时，质量块受到重力向下拉扯，弹性梁发生形变，输出为1g（约9.8 m/s²）的读数，方向指向重力加速度的反方向（即向上）。

2.1.2 输出特性与关键参数

数字加速度计通过ADC将模拟电压量化为数字量，通常以LSB/g（每g对应的最低有效位）表示灵敏度。例如，量程为±4g、16位输出的传感器，其灵敏度为 2^16 / 8g = 8192 LSB/g。实际输出代码为有符号整数，需除以灵敏度并乘以重力加速度常数才能转换为物理单位。加速度计的主要性能指标包括：

• 量程（Range）：可测量的最大加速度范围，常见±2g、±4g、±8g、±16g。量程越大，灵敏度越低，噪声相对增大。
• 零偏（Bias）：零加速度输入时的输出偏移，由制造误差和温度漂移引起，单位mg。
• 噪声密度（Noise Density）：单位带宽内的噪声均方根值，单位 μg/√Hz。积分时间越长，噪声累积越大。
• 带宽（Bandwidth）：内部低通滤波器的截止频率，通常可配置为10Hz~1000Hz。带宽越高，响应越快，但噪声越大。

2.1.3 场景化理解：手机屏幕旋转

当手机从竖屏旋转为横屏时，重力在X轴和Y轴上的投影分量发生变化。假设手机平放时Z轴输出约9.8 m/s²，X/Y轴接近0。旋转90°后，重力完全落在X轴上，此时X轴输出约9.8 m/s²，Z轴输出接近0。通过计算重力矢量与各轴的夹角，即可确定屏幕方向。但若手机在颠簸的汽车中，加速度计会同时测量到振动产生的动态加速度，导致姿态角抖动，此时就需要低通滤波或互补滤波来抑制高频噪声。

2.2 陀螺仪工作原理与输出特性

2.2.1 核心原理：MEMS振动质量与科里奥利力

MEMS陀螺仪利用科里奥利效应（Coriolis Effect）测量角速度。陀螺仪内部有一个高速振动的质量块，当传感器绕敏感轴旋转时，质量块受到科里奥利力作用，产生垂直于振动方向的位移。该位移同样通过电容检测转换为电压信号。与加速度计不同，陀螺仪测量的是角速度（rad/s），而非角度。要获得角度，必须对角速度进行时间积分，但积分过程会累积零偏漂移，导致角度随时间发散。

2.2.2 输出特性与关键参数

陀螺仪的输出同样为数字量，灵敏度单位为LSB/(°/s)。例如，量程±250°/s、16位输出，灵敏度为 2^16 / 500 = 131 LSB/(°/s)。陀螺仪的关键性能指标包括：

• 量程：常见±125、±250、±500、±1000、±2000°/s。高量程适合快速旋转场景，但分辨率降低。
• 零偏稳定性（Bias Stability）：在恒定温度下，零偏随时间缓慢漂移的程度，单位°/h。这是陀螺仪最重要的指标之一。
• 角度随机游走（ARW）：由白噪声积分引起的角度误差累积，单位°/√h。ARW越小，角度估计越平滑。
• 刻度因子误差（Scale Factor Error）：实际灵敏度与标称灵敏度的偏差，通常为百分比（%）。

2.2.3 场景化理解：无人机偏航角估计

无人机悬停时，陀螺仪Z轴输出接近0°/s。当遥控器发出偏航指令，无人机绕Z轴旋转，陀螺仪输出角速度。若将角速度积分，理论上可获得偏航角。但实际中，陀螺仪存在约±0.5°/s的零偏，积分10秒后角度误差达5°，导致无人机机头方向偏移。因此，工程上通常使用磁力计或视觉传感器对偏航角进行周期性校正，或采用卡尔曼滤波融合多种传感器。

2.3 坐标系定义与单位体系

2.3.1 载体坐标系（b系）与导航坐标系（n系）

IMU数据必须定义在明确的坐标系中才有意义。常用的载体坐标系（b系）以传感器封装中心为原点，X轴指向载体前方（或右方），Y轴指向左方（或前方），Z轴垂直向上，满足右手定则。导航坐标系（n系）通常采用“东-北-天”（ENU）或“北-东-地”（NED）定义。姿态解算的本质是求取b系到n系的旋转矩阵或四元数。在数据读取时，必须确认传感器数据手册中的轴定义，不同厂商（如ST、Bosch、InvenSense）的轴方向可能不同，甚至同一芯片的加速度计和陀螺仪轴方向也可能不一致。

2.3.2 单位换算与数据转换

原始ADC输出为整数，需转换为物理单位。加速度计物理单位为 m/s²，但工程中常用g（9.80665 m/s²）作为中间单位。陀螺仪物理单位为 rad/s，但数据手册常用°/s。换算关系为：1 rad/s = 57.2958 °/s。在代码实现中，建议统一使用国际单位制（SI）进行滤波计算，仅在数据输出时转换为用户习惯的单位。以下为典型的原始数据转换代码：

// 假设加速度计量程±4g，灵敏度8192 LSB/g
float acc_x = (float)raw_acc_x / 8192.0f * 9.80665f; // 单位: m/s²

// 假设陀螺仪量程±250°/s，灵敏度131 LSB/(°/s)
float gyro_z = (float)raw_gyro_z / 131.0f * 0.0174533f; // 单位: rad/s

2.3.3 坐标系对齐与安装误差

实际PCB安装时，传感器芯片与设备外壳的机械轴可能存在微小旋转，导致测量数据与理想坐标系不一致。这种安装误差可通过六面静态标定法求解旋转矩阵进行补偿。此外，加速度计与陀螺仪的敏感轴也可能不完全正交，产生交叉轴耦合误差。在低成本IMU中，交叉轴误差通常为1%~2%，对高精度姿态估计有显著影响。

2.4 实战案例：IMU数据采集与预处理

2.4.1 案例背景与目标

某轮式机器人项目需要估计车身俯仰角，用于坡道行驶时的速度控制。选用BMI088六轴IMU，加速度计量程±6g，陀螺仪量程±1000°/s。初始现象：直接读取原始数据并计算俯仰角，发现角度在静止时波动达±3°，且长时间运行后缓慢漂移。目标：通过正确的数据转换和静态标定，将静止俯仰角波动降低到±0.5°以内。

2.4.2 关键输入数据与问题分析

采集静止状态下1分钟数据，加速度计Z轴输出均值约为 1000 LSB（对应约0.98g），但波动幅度达±50 LSB。陀螺仪X轴（俯仰轴）输出均值约为 5 LSB（对应约0.04°/s），但存在明显的低频漂移。分析判断：加速度计波动主要来源于振动噪声和量化噪声，陀螺仪漂移来源于零偏不稳定性和温度变化。直接使用加速度计计算俯仰角，公式为 pitch = atan2(acc_y, acc_z)，由于加速度计噪声较大，角度波动明显。

2.4.3 操作步骤与结果对比

1. 数据转换：将原始LSB转换为物理单位，加速度计灵敏度为 2^16 / 12g = 5461 LSB/g，陀螺仪灵敏度为 2^16 / 2000 = 32.8 LSB/(°/s)。
2. 静态零偏标定：采集1000组静止数据，计算陀螺仪X轴零偏均值并扣除。
3. 低通滤波：对加速度计数据施加截止频率5Hz的二阶巴特沃斯低通滤波器，抑制振动噪声。
4. 互补滤波：将滤波后的加速度计俯仰角与陀螺仪积分角度进行融合，权重系数α=0.02。

实施后，静止俯仰角波动从±3°降低到±0.3°，动态响应延迟约0.2秒，满足坡道控制需求。代价是低通滤波引入了约0.1秒的相位延迟，在快速加减速场景下需调整截止频率。

2.5 常见误区与总结

• 误区一：认为加速度计输出为“加速度”，直接积分求速度。实际上输出为比力，包含重力分量，必须先扣除重力。
• 误区二：忽略陀螺仪零偏的温度效应。在温度变化环境中，零偏可能漂移数°/s，导致积分角度严重发散。
• 误区三：混淆坐标系轴方向。不同厂商的IMU轴定义可能不同，代码移植时必须重新验证。
• 误区四：盲目提高滤波器阶数。高阶滤波器带来更陡峭的截止特性，但相位延迟更大，可能破坏控制系统稳定性。