3. 传感器选型与特性分析
姿态航向参考系统（AHRS）的核心任务，是在没有外部基准持续介入的情况下，实时给出载体的横滚、俯仰与航向角。完成这一任务的最小传感器组合通常由三类器件构成：MEMS陀螺仪测量角速度，加速度计测量比力（可感知重力方向），磁力计测量地磁场矢量。三者并非简单叠加，而是通过互补的物理特性共同约束姿态解算：陀螺仪短期动态好但存在漂移，加速度计长期稳定但受运动加速度干扰，磁力计提供绝对航向但易受铁磁与电流磁场污染。理解它们的工作原理、关键指标与误差模型，是选型与后续融合算法设计的前提。
一、三类传感器的工作原理
MEMS陀螺仪基于科里奥利效应工作。以常见的音叉式结构为例，驱动质量块在平面内以固定频率振动，当载体绕敏感轴旋转时，科里奥利力使质量块在正交方向产生位移，该位移经电容检测转换为与角速度成正比的电信号。输出量是角速度 ω（单位 °/s 或 rad/s），需要对角速度积分才能得到角度。因此陀螺仪本身不直接给出姿态，而是提供姿态变化的速率信息。
MEMS加速度计通常采用梳齿电容或压阻结构，检测质量块在加速度作用下的位移。静止时，它测量的是重力加速度在敏感轴上的分量，因此可用于计算横滚与俯仰：
roll = atan2(ay, az)
pitch = atan2(-ax, sqrt(ay^2 + az^2))注意该式仅在载体近似静止或匀速运动时成立。一旦存在机动加速度，加速度计输出将混入运动分量，导致姿态角计算出现偏差。
磁力计多采用各向异性磁阻（AMR）或霍尔效应原理，测量地磁场矢量在机体三轴上的分量。地磁场水平分量指向磁北，因此磁力计可提供绝对航向参考。但磁力计输出受硬磁与软磁干扰影响显著，且需要结合当地磁倾角进行倾斜补偿，才能得到可靠的航向角。
二、关键指标与误差模型
选型时不能只看量程和价格，以下指标直接决定融合算法的复杂度与最终精度。
| 指标 | 陀螺仪 | 加速度计 | 磁力计 |
|---|---|---|---|
| 核心输出 | 角速度 (°/s) | 比力 (g 或 m/s²) | 磁场强度 (μT 或 Gauss) |
| 零偏 | 典型 0.5～10 °/s，温漂显著 | 典型 10～100 mg | 硬磁偏移可达数百 μT |
| 噪声密度 | 0.005～0.05 °/s/√Hz | 50～300 μg/√Hz | 0.1～1 μT/√Hz |
| 主要误差 | 零偏不稳定性、角度随机游走、标度因数非线性 | 零偏、噪声、运动加速度耦合 | 硬磁/软磁、倾斜误差、附近电流干扰 |
| 长期特性 | 积分漂移，需外部校正 | 长期稳定，可作水平基准 | 提供绝对航向，但需校准 |
陀螺仪的误差模型可简化为：
ω_meas = (1 + S) · ω_true + b + n其中 S 为标度因数误差矩阵，b 为零偏，n 为随机噪声。零偏 b 随温度和时间缓慢变化，是积分漂移的主要来源。加速度计误差模型类似，但需额外考虑运动加速度 a_motion 的叠加。磁力计误差通常建模为：
B_meas = A · B_true + b_hard + nA 为软磁矩阵，b_hard 为硬磁偏移。硬磁偏移可通过椭球拟合校准消除，软磁矩阵则需通过多位置旋转标定求解。
三、选型依据与工程权衡
选型应从任务需求反推。以小型无人机AHRS为例，假设要求静态航向精度优于 2°，动态横滚/俯仰误差小于 1°。此时陀螺仪零偏不稳定性应优于 10 °/h，噪声密度低于 0.02 °/s/√Hz；加速度计噪声密度低于 100 μg/√Hz；磁力计需具备硬磁校准能力，且采样率不低于 50 Hz。
若载体存在强振动，应优先选择带机械阻尼或内置低通滤波的加速度计，避免振动整流误差。若载体附近有电机、电源线等干扰源，磁力计应远离这些部件安装，或选用带置位/复位线圈的器件以抑制偏移漂移。对于低成本消费级应用，可接受陀螺仪零偏 1～5 °/s，但必须配合加速度计与磁力计进行持续校正；对于高精度工业级应用，则需选用零偏不稳定性优于 1 °/h 的陀螺仪，并配合温度补偿。
- 陀螺仪：量程是否覆盖最大角速度？零偏不稳定性与噪声密度是否满足积分漂移要求？
- 加速度计：量程是否覆盖机动加速度？噪声密度是否低于姿态角分辨率要求？
- 磁力计：是否支持硬磁/软磁校准？采样率与分辨率是否满足航向更新率？
- 环境：安装位置是否远离振动源与磁场干扰源？温度范围是否覆盖工作环境？
- 接口：SPI/I²C 速率是否满足多传感器同步采样？是否支持中断与 FIFO？
实际选型中，三类传感器的性能需匹配。若陀螺仪精度很高但加速度计噪声很大，融合后的姿态精度仍受限于加速度计；反之亦然。因此，建议先根据任务精度指标分配误差预算，再分别确定各传感器的关键指标，最后通过实测校准与融合算法验证是否达标。