2、IMU基础概念：惯性测量单元定义、加速度计、陀螺仪、磁力计的工作原理与输出特性

IMU（Inertial Measurement Unit，惯性测量单元）是姿态解算系统的“感官器官”。无论是四旋翼无人机、平衡小车、AR/VR 头显，还是机器人关节反馈，其姿态估计的原始数据都来源于 IMU 内部的三类传感器：加速度计、陀螺仪和磁力计。理解这三类传感器各自的工作原理、输出特性与局限性，是后续进行传感器校准、数据融合和姿态解算的基石。本章将深入剖析 IMU 的定义、内部传感器工作机制，并结合实际工程场景分析其输出数据的物理意义与使用陷阱。

2.1 惯性测量单元（IMU）的定义与系统角色

核心原理：IMU 是一种电子器件组合，它通过内部的惯性传感器（加速度计、陀螺仪）以及参考传感器（磁力计）来测量物体在三维空间中的运动状态。从工程定义上讲，一个完整的 9 轴 IMU 包含三轴加速度计、三轴陀螺仪和三轴磁力计。加速度计测量物体受到的“比力”（Specific Force），即物体相对于自由落体的加速度差；陀螺仪测量物体绕自身三个正交轴的旋转角速度；磁力计则测量地球磁场在传感器坐标系下的分量，用于提供绝对航向参考。

在姿态解算系统中，IMU 的角色是提供原始测量数据。它不直接输出姿态角，而是输出三个传感器各自坐标系下的物理量。后续的算法（如互补滤波、卡尔曼滤波）将这些原始数据融合，才能得到稳定的 Roll（横滚角）、Pitch（俯仰角）和 Yaw（偏航角）。理解 IMU 的定义，需要明确其与“姿态传感器”（如 MPU6050 自带 DMP）的区别：IMU 是数据源，而姿态解算引擎是数据处理逻辑。

2.2 加速度计：测量比力与姿态倾斜

工作原理：加速度计的核心是一个质量块-弹簧-阻尼系统。当 IMU 处于静止状态时，质量块受到重力作用，产生一个与重力方向相反的惯性力，导致电容或压阻效应发生变化，从而输出对应的电压信号。这里的关键物理概念是：加速度计无法区分“重力加速度”和“运动加速度”。它测量的是 比力 f = a - g（其中 a 是物体在惯性空间中的绝对加速度，g 是重力加速度向量）。

输出特性与判断方法：当 IMU 水平静止放置时，Z 轴输出约为 +1g（或 -1g，取决于传感器轴向定义），X 和 Y 轴输出接近 0g。当设备倾斜时，重力向量会在三个轴上产生投影分量。通过计算 pitch = atan2(Ax, sqrt(Ay² + Az²)) 和 roll = atan2(Ay, sqrt(Ax² + Az²))，可以初步得到静态姿态角。但需要注意，加速度计对振动和线性加速度非常敏感。例如，在无人机高速飞行或电机振动时，加速度计输出会混入大量高频噪声和运动加速度分量，导致姿态角计算失真。

案例拆解：在平衡小车项目中，我们曾遇到启动瞬间小车向前猛冲的问题。排查发现，加速度计在电机启动瞬间检测到强烈的水平加速度（约 0.3g），导致解算出的 Pitch 角瞬间偏移 15°。控制算法误以为车身前倾，于是加大电机出力，形成正反馈。解决方案是在软件中加入低通滤波器（截止频率 20Hz），并采用加速度计与陀螺仪融合的策略，而非直接信任加速度计的瞬时值。

2.3 陀螺仪：测量角速度与积分漂移

工作原理：MEMS 陀螺仪基于科里奥利效应。当质量块在驱动轴上高速振荡，并同时绕敏感轴旋转时，会产生一个垂直于驱动轴和旋转轴的科里奥利力。该力的大小与输入角速度成正比，通过检测该力引起的电容变化，即可得到角速度值。陀螺仪输出的是 角速度（°/s 或 rad/s），而非角度。

输出特性与操作流程：要获得角度，必须对角速度进行时间积分。例如，若陀螺仪 Z 轴输出恒定 10°/s，持续 0.5 秒，则 Yaw 角变化为 5°。然而，陀螺仪存在零偏（Bias）和零偏稳定性问题。零偏是指静止时输出不为 0 的偏移量；零偏稳定性则指该偏移量随时间缓慢变化。积分操作会将零偏累积为不断增长的角度误差，这就是“漂移”现象。

// 陀螺仪积分伪代码示例
float angle_z = 0.0f;
float dt = 0.005f; // 采样周期 5ms
float gyro_z_raw = read_gyro_z(); // 读取原始值
float gyro_z_rate = (gyro_z_raw - gyro_z_offset) * sensitivity; // 减去零偏并转换单位
angle_z += gyro_z_rate * dt; // 积分得到角度

案例拆解：某四旋翼无人机在悬停 2 分钟后，机头缓慢向右偏转 30°。通过日志分析发现，陀螺仪 Z 轴零偏为 0.05°/s，且未在起飞前进行动态校准。0.05°/s 的零偏在 120 秒内累积了 6° 的误差，加上温度变化引起的零偏漂移，最终导致 30° 的偏航误差。解决措施：在每次上电时采集 100 组静止数据求平均作为零偏，并在飞行过程中使用磁力计对 Yaw 进行周期性修正。

2.4 磁力计：测量磁场与航向参考

工作原理：磁力计（电子罗盘）基于磁阻效应或霍尔效应，测量地球磁场在传感器三个轴向上的分量。地球磁场在水平面上的分量总是指向磁北（与地理北极存在磁偏角），因此通过计算水平磁场分量的方向，可以得到航向角 Yaw。其输出单位为微特斯拉（μT）或高斯（Gauss）。

输出特性与判断方法：磁力计的输出极易受到环境磁场干扰。硬磁干扰（如扬声器、电机磁铁）会导致输出产生固定偏置；软磁干扰（如 PCB 走线、金属外壳）会导致磁场形状畸变。因此，磁力计在使用前必须进行椭圆拟合校准。在姿态解算中，通常先将磁力计向量从载体坐标系转换到水平坐标系（利用加速度计得到的 Roll/Pitch），然后计算 Yaw：yaw = atan2(Mx_h, My_h)，其中 Mx_h 和 My_h 是水平化后的磁场分量。

案例拆解：在室内巡检机器人项目中，磁力计 Yaw 数据在机器人经过电机驱动器上方时跳变 20°。经排查，驱动器的大电流（10A）产生了约 50μT 的附加磁场，远大于地球磁场（约 50μT）本身。我们采取了以下措施：1) 将磁力计远离电机驱动板，距离从 2cm 增加到 8cm；2) 在电机 PWM 关闭的瞬间（电流为零）采样磁力计数据；3) 在算法中增加磁力计异常值检测，当磁场强度模长超出正常范围（±20%）时，丢弃该次 Yaw 修正。最终航向精度从 ±10° 提升到 ±2°。

2.5 三传感器协同与输出特性对比

核心原理：没有任何一个传感器能独立提供完整、长期稳定的姿态。加速度计在静止时提供绝对 Roll/Pitch 参考，但动态性能差；陀螺仪在动态时提供平滑的角速度积分，但存在漂移；磁力计提供绝对 Yaw 参考，但易受干扰。三者的频域特性互补：加速度计适合低频（<1Hz）姿态参考，陀螺仪适合高频（>1Hz）姿态变化跟踪。

操作流程：在实际工程中，通常采用互补滤波或卡尔曼滤波。互补滤波的核心思想是：对加速度计和磁力计解算的姿态进行低通滤波，对陀螺仪积分的姿态进行高通滤波，然后相加。卡尔曼滤波则通过建立状态方程和观测方程，根据噪声协方差动态调整权重。无论哪种方法，都需要先对三个传感器进行校准，并统一时间戳和坐标系。