2、传感器基础：加速度计、陀螺仪、磁力计的工作原理与输出特性
姿态估计系统的核心在于三类惯性及磁场传感器：加速度计（Accelerometer）、陀螺仪（Gyroscope）和磁力计（Magnetometer）。它们分别测量物体的线加速度、角速度和周围磁场强度，三者特性互补，共同构成传感器融合的数据基础。理解每种传感器内部的物理实现、输出坐标系、噪声特性以及失效模式，是设计可靠姿态解算算法的前提。本章将逐一剖析其工作原理，并重点对比它们在动态环境下的表现差异。
2.1 加速度计：重力矢量与比力测量
加速度计并非直接测量运动加速度，而是测量“比力”（Specific Force），即单位质量上受到的除重力以外的外力之和。在静止状态下，加速度计感受到的实际上是支撑力（如桌面向上推的力），其数值等于重力加速度 g，方向竖直向上。这一特性使得加速度计在静态或准静态条件下，能够直接提供重力矢量在传感器坐标系中的投影，从而计算出俯仰角（Pitch）和横滚角（Roll）。
MEMS 加速度计常见实现方式包括电容式、压阻式和热对流式。其中电容式最为普及，其核心结构是一个可移动的微机械质量块，通过弹性梁悬挂在基板上。当传感器沿敏感轴加速时，质量块因惯性发生位移，导致两侧固定电极与质量块之间的电容差发生变化，通过测量差分电容即可反推加速度大小。现代数字加速度计（如 Bosch BMI160、ST LSM6DSO）内部集成 16 位 ADC、可配置量程（±2g 至 ±16g）以及片上数字滤波。
- 静态参考性：静止时输出矢量模长应等于 1g（约 9.8 m/s²），方向指向天顶的反方向。
- 动态失真：当设备存在线性运动加速度时，输出为重力与运动加速度的矢量和，此时直接用于姿态解算会产生显著误差。
- 噪声特性：加速度计通常具有较高的白噪声密度（典型值 150-300 μg/√Hz），高频段噪声明显。
- 带宽限制：受机械结构谐振频率影响，有效带宽通常为 100-500 Hz，超出后相位失真严重。
在姿态解算中，加速度计扮演“长期参考”的角色。由于它不存在积分漂移，可以持续修正陀螺仪积分带来的累积误差。但必须注意，任何非重力加速度（如车辆转弯时的向心加速度、机械臂运动时的惯性力）都会污染这一参考信号，因此融合算法中通常需要动态调整对加速度计的信任权重。
2.2 陀螺仪：角速度测量与积分特性
陀螺仪测量的是物体绕自身三个正交轴旋转的角速度。MEMS 陀螺仪基于科里奥利效应（Coriolis Effect）工作：一个质量块被驱动以高频振动，当传感器绕敏感轴旋转时，质量块受到科里奥利力作用，产生垂直于振动方向的位移，该位移与输入角速度成正比。通过电容检测该位移，即可得到角速度值。
陀螺仪的核心优势在于其动态响应极快，不受线性加速度影响，能够精确捕捉快速旋转运动。在姿态融合中，陀螺仪提供短时高精度的姿态增量，通过积分即可获得相对姿态变化。然而，积分过程会累积多种误差源：
- 零偏（Bias）：即使静止时，陀螺仪输出也不为零，典型值为 ±1°/s 至 ±5°/s。零偏随时间、温度缓慢漂移。
- 随机游走（Angle Random Walk, ARW）：白噪声积分后形成角度随机游走，是姿态漂移的主要来源。
- 刻度因子误差：实际输出与真实角速度之间存在比例偏差，通常为 0.1%-1%。
- 温度敏感性：零偏随温度变化率可达 0.01°/s/°C，需要温度补偿。
陀螺仪的输出特性决定了它在融合算法中的角色：提供高频姿态变化信息，但需要外部参考（加速度计、磁力计）不断“校正”其积分漂移。互补滤波器的本质，正是将陀螺仪的高通滤波输出与加速度计/磁力计的低通滤波输出相加，实现频域上的优势互补。
2.3 磁力计：地磁场测量与航向参考
磁力计测量传感器所在位置的磁场强度矢量。在地球表面，地磁场强度约为 25-65 μT，方向从地理南极指向地理北极（磁北极），且与水平面存在磁倾角（Inclination Angle）。磁力计通过检测磁场在传感器三轴上的分量，可以计算出设备相对于磁北的航向角（Yaw）。
MEMS 磁力计主要采用各向异性磁阻（AMR）效应或霍尔效应。AMR 磁力计（如 Honeywell HMC5883L）内部包含坡莫合金薄膜，其电阻随外部磁场方向变化而变化，通过惠斯通电桥测量电阻差即可得到磁场分量。现代磁力计（如 LIS3MDL、AK09918）通常集成 16 位 ADC，量程为 ±4 Gauss 至 ±16 Gauss。
磁力计在实际应用中面临严峻挑战：
- 硬磁干扰（Hard Iron）：电路板上的永磁体、扬声器、电机等产生固定偏置磁场，导致输出球心偏移。
- 软磁干扰（Soft Iron）：铁磁性材料（如钢制外壳、电池）会扭曲磁场线，导致输出球体变形为椭球。
- 环境磁场：高压线、金属结构、电子设备等会产生局部磁场异常。
- 倾斜补偿需求：当设备存在俯仰或横滚时，必须结合加速度计数据进行倾斜补偿，才能正确计算航向。
磁力计在融合系统中的角色是提供航向参考。与加速度计类似，它也存在动态响应慢、易受干扰的问题，因此通常与陀螺仪进行互补：低频信任磁力计的航向，高频信任陀螺仪的角速度积分。
2.4 三类传感器特性对比与选型考量
| 特性维度 | 加速度计 | 陀螺仪 | 磁力计 |
|---|---|---|---|
| 物理量 | 比力（m/s²） | 角速度（°/s） | 磁场强度（μT） |
| 静态参考 | 重力矢量（俯仰/横滚） | 无（需积分） | 地磁场（航向） |
| 动态响应 | 较差（受运动加速度干扰） | 优秀（快速旋转） | 较差（磁滞效应） |
| 漂移特性 | 无积分漂移 | 积分后累积漂移 | 无积分漂移，但有环境漂移 |
| 主要噪声源 | 机械热噪声 | 角度随机游走（ARW） | 电子噪声、环境磁场波动 |
| 典型量程 | ±2g ~ ±16g | ±125°/s ~ ±2000°/s | ±4G ~ ±16G |
| 融合中的角色 | 低频姿态参考 | 高频姿态预测 | 低频航向参考 |
选型时需根据应用场景权衡：无人机需要大量程陀螺仪（±1000°/s 以上）以应对快速机动；机器人导航更关注磁力计的精度和抗干扰能力；可穿戴设备则需低功耗、低噪声的加速度计。此外，现代 IMU 芯片（如 ICM-20948）将三轴加速度计、三轴陀螺仪和三轴磁力计集成于单芯片，内部已做时间同步，可显著降低融合算法的实现复杂度。
2.5 实战场景：从原始数据到可用姿态的预处理链路
以一款典型的四旋翼无人机飞控为例，其姿态解算前的传感器预处理流程如下：
- 上电初始化：读取芯片 ID，配置量程、采样率、数字滤波器带宽。加速度计量程设为 ±8g，陀螺仪 ±1000°/s，磁力计 ±8G。
- 静止采集：无人机放置于水平桌面，采集 500 ms 数据。计算陀螺仪三轴零偏均值，存入非易失性存储器。
- 磁力计校准：执行 8 字旋转，采集 2000 个样本，使用最小二乘法拟合椭球参数，得到硬磁偏置和软磁矩阵。
- 数据同步：通过 SPI 接口以 1 kHz 读取加速度计和陀螺仪数据，以 100 Hz 读取磁力计数据。使用 FIFO 或时间戳对齐。
- 单位换算：将原始 LSB 值转换为物理单位：加速度 = raw × 量程 / 32768，角速度 = raw × 量程 / 32768，磁场 = raw × 量程 / 32768。
- 低通滤波：对加速度计数据施加 20 Hz 低通滤波（消除振动噪声），对磁力计施加 10 Hz 低通滤波（消除高频电磁干扰）。
- 归一化与参考矢量构造：将加速度计输出归一化作为重力参考，将磁力计输出投影到水平面后归一化作为航向参考。
2.6 常见误区与总结
在理解和应用三类传感器时，工程师常陷入以下误区：
- 误区一：认为加速度计可以直接测量运动加速度。实际上它测量的是比力，包含重力分量，需要先减去重力才能得到运动加速度。
- 误区二：忽视陀螺仪零偏的温度漂移。许多团队在实验室校准后直接部署，现场温度变化导致姿态漂移加剧。
- 误区三：磁力计校准一次后永久使用。产品外壳更换、电池更换或附近新增金属部件后，软磁干扰特性改变，必须重新校准。
- 误区四：所有传感器使用相同采样率。磁力计带宽低，若以 1 kHz 采样并直接参与融合，会引入高频噪声。
总结而言，加速度计、陀螺仪和磁力计各自提供了姿态估计所需的互补信息：加速度计给出水平基准，陀螺仪给出短时高动态精度，磁力计给出航向。理解它们的物理原理、输出特性和误差模型，是设计有效融合算法的第一步。下一阶段将在此基础上，讨论如何通过互补滤波或卡尔曼滤波将这些原始数据转化为稳定、准确的姿态角。