2、IMU基础知识：加速度计、陀螺仪、磁力计的工作原理、测量模型、坐标系定义及常见误差源

IMU（Inertial Measurement Unit，惯性测量单元）是PX4无人机飞控系统中感知自身运动状态的核心传感器组合。在PX4的EKF2（扩展卡尔曼滤波器）估计器中，IMU数据是姿态解算、位置估计和速度控制的基础输入。如果对IMU的工作原理、测量模型和误差特性缺乏系统理解，就无法正确解读PX4的震动日志、判断传感器健康状态，更难以定位飞行中的异常抖动或漂移问题。本节将深入拆解加速度计、陀螺仪和磁力计的工作机制，建立完整的坐标系与误差分析框架，为后续章节的异常检测方法打下理论基础。

2.1 加速度计：感知比力的核心传感器

2.1.1 工作原理与测量模型

加速度计测量的是比力（Specific Force），即物体受到的除重力以外的合力加速度。MEMS加速度计内部包含一个质量块和弹性悬臂结构，当无人机加速或倾斜时，质量块因惯性产生位移，通过电容或压阻效应转化为电信号。关键点在于：加速度计无法区分重力加速度和运动加速度，它测量的是 a_meas = a_body - g（其中g为重力加速度向量）。当无人机悬停时，加速度计读数为 [0, 0, +9.8] m/s²（Z轴向下），而非零。

在PX4中，加速度计数据经过低通滤波后进入EKF2，用于姿态初始对准和水平加速度估计。测量模型可表示为：

a_meas = R^T * (a_body - g) + b_a + s_a * a_body + n_a

其中 R 为旋转矩阵，b_a 为零偏，s_a 为尺度因子误差，n_a 为随机噪声。PX4的校准流程（accel_calibration）通过六面静止采集，估计零偏和尺度因子。

2.1.2 震动对加速度计的影响

无人机电机高速旋转产生的机械震动会直接耦合到加速度计输出。当震动频率接近或超过采样频率的1/2时，会产生混叠效应（Aliasing），导致低频段出现虚假信号。PX4默认加速度计采样率为1kHz，但震动能量集中在100-500Hz时，若未使用合适的低通滤波器（如 IMU_ACCEL_CUTOFF），高频震动会污染姿态估计。典型表现是悬停时姿态角出现周期性抖动，日志中 accel_vibration 指标持续偏高。

2.1.3 案例：震动导致的加速度计饱和

某四旋翼在更换碳纤维桨叶后，悬停时出现轻微晃动。通过分析ULog日志发现，加速度计X轴峰值达到 ±35 m/s²（正常应 ±12 m/s²），且FFT频谱显示在250Hz处有明显能量峰。进一步检查发现，新桨叶动平衡不良导致机身共振。解决措施：更换动平衡合格的桨叶，并将 IMU_ACCEL_CUTOFF 从默认的80Hz降至50Hz，震动指标恢复正常，姿态波动幅度从±3°降至±0.8°。

2.2 陀螺仪：角速度测量的关键

2.2.1 工作原理与测量模型

MEMS陀螺仪基于科里奥利效应（Coriolis Effect）工作。内部质量块以高频振动，当无人机旋转时，科里奥利力使质量块在垂直方向产生位移，通过电容检测得到角速度。陀螺仪测量的是机体相对于惯性空间的角速度 ω = [p, q, r]，分别对应滚转、俯仰、偏航角速度。测量模型为：

ω_meas = ω_true + b_g + s_g * ω_true + n_g

陀螺仪零偏 b_g 是姿态漂移的主要来源。PX4在每次起飞前通过静止采集计算初始零偏（gyro_calibration），但飞行中温度变化会导致零偏缓慢漂移，EKF2通过加速度计和磁力计持续修正这一误差。

2.2.2 陀螺仪噪声与角度随机游走

陀螺仪输出中的白噪声经过积分后，会形成角度随机游走（Angle Random Walk, ARW）。ARW的单位为 °/√h，表示噪声随时间累积的速率。例如，ARW为0.5°/√h的陀螺仪，在1小时后姿态漂移约0.5°。PX4中可通过 IMU_GYRO_RATEMAX 设置陀螺仪采样率，但更高的采样率并不一定改善ARW，因为高频噪声同样被积分。实际工程中，应关注Allan方差分析结果，选择ARW较低的传感器。

2.2.3 温度漂移的工程处理

MEMS陀螺仪的零偏对温度极其敏感，典型漂移率为 0.01-0.05 °/s/°C。PX4的EKF2内置了温度补偿模型，但前提是传感器内部温度传感器工作正常。在寒冷天气飞行时，若起飞前未充分预热，陀螺仪零偏可能达到 ±5 °/s，导致起飞瞬间姿态估计错误。建议在PX4参数中启用 IMU_GYRO_TEMP_COMP，并在起飞前保持无人机静止至少30秒，让EKF2完成零偏收敛。

2.3 磁力计：航向参考与局限性

2.3.1 工作原理与测量模型

磁力计测量地球磁场向量在机体坐标系中的投影。地球磁场强度约为 25-65 μT，方向从南磁极指向北磁极（磁北极）。磁力计输出 m = [m_x, m_y, m_z]，结合加速度计确定的水平面，可以解算出航向角（偏航角）。测量模型为：

m_meas = R * m_earth + b_hard + S_soft * m_earth + n_m

其中 b_hard 为硬铁误差（Hard Iron），由机载电子设备产生的固定磁场偏移；S_soft 为软铁误差（Soft Iron），由周围铁磁性材料对磁力线的扭曲造成。PX4的 mag_calibration 通过旋转无人机采集多方向数据，估计并补偿这两类误差。

2.3.2 磁力计的干扰源与检测

磁力计对电流产生的磁场极其敏感。当无人机电机大电流工作时（如急加速或大负载），电源线产生的磁场会叠加到磁力计输出上。PX4中可通过 SENS_MAG_AUTOROT 参数启用自动旋转补偿，但更有效的方法是将磁力计远离电源线和电机（通常要求距离>10cm）。在日志中，若磁力计模长 |m| 波动超过正常值的15%，或航向估计与GPS航向偏差持续大于10°，应怀疑磁干扰。

2.3.3 案例：电机电流导致的磁航向漂移

一架六旋翼在满载飞行时，PX4切换到定高模式后出现持续偏航漂移。日志分析显示，磁力计Z轴读数在油门增加时从 35 μT 跳变至 42 μT，且与电机电流呈正相关。检查发现，电池主电源线从磁力计正上方穿过，大电流产生的磁场干扰了航向参考。解决方案：将磁力计移至机臂末端，并增加铝箔屏蔽层。重新校准后，航向误差从±8°降至±1.5°。

2.4 坐标系定义与PX4中的约定

2.4.1 机体坐标系与地面坐标系

PX4采用NED（North-East-Down）右手坐标系约定。机体坐标系（Body Frame）定义为：X轴指向机头前方，Y轴指向机身右侧，Z轴垂直向下。地面坐标系（Earth Frame）定义为：X轴指向地理北极，Y轴指向正东，Z轴指向地心。姿态角（Roll/Pitch/Yaw）描述机体坐标系相对于地面坐标系的旋转关系，使用Z-Y-X欧拉角顺序。

2.4.2 传感器安装方向与PX4参数

实际安装中，IMU芯片的封装方向可能与机体坐标系不完全对齐。PX4通过 CAL_ACC0_X/Y/Z 和 CAL_GYRO0_X/Y/Z 参数定义旋转偏移。若安装偏差超过5°，会导致姿态估计出现恒定误差。建议在飞控固件烧录后，使用PX4的 board orientation 设置（如 SENS_BOARD_ROT）进行整体旋转补偿，再通过六面校准精确修正。

2.5 常见误差源总结与PX4日志指标

2.5.1 误差源分类与影响

IMU误差可分为确定性误差和随机误差两类。确定性误差包括零偏、尺度因子、交叉轴耦合，可通过校准消除；随机误差包括角度随机游走、速度随机游走、偏置不稳定性，无法完全消除，只能通过滤波抑制。PX4的EKF2在运行时会持续估计零偏，但高频震动和温度突变会降低估计精度。

2.5.2 震动对IMU的综合影响

震动不仅影响加速度计，还会通过结构传导影响陀螺仪。高频震动（>200Hz）主要影响加速度计，导致比力测量出现高频噪声；低频震动（<50Hz）主要影响陀螺仪，导致角速度测量出现周期性偏差。PX4的 IMU_GYRO_CUTOFF 和 IMU_ACCEL_CUTOFF 参数分别控制低通滤波频率，合理设置可显著改善姿态估计质量。

2.5.3 案例：减震失效的排查流程

某飞手反馈无人机在飞行中出现“高频抖动”，日志显示 accel_vibration 达到 1.2 m/s²（正常<0.3）。排查步骤：

1. 检查飞控减震海绵是否老化变形（目视检查）
2. 使用PX4的 commander status 命令查看传感器健康状态
3. 分析FFT频谱，确认震动峰值频率（本例为180Hz）
4. 更换减震球并重新进行加速度计校准
5. 复飞后震动指标降至 0.2 m/s²，抖动消失

此案例说明，震动问题往往需要结合机械检查和软件滤波参数调整，单一手段难以彻底解决。

2.6 总结与工程实践要点

理解IMU的基础知识是进行异常检测的前提。加速度计提供重力参考和水平加速度，陀螺仪提供角速度积分姿态，磁力计提供航向参考。三者通过EKF2融合，形成完整的姿态和位置估计。在实际工程中，应重点关注以下要点：

• 校准是基础：每次更换硬件或飞控安装后，必须执行完整的加速度计、陀螺仪和磁力计校准。
• 震动是头号敌人：定期检查减震系统，使用日志中的震动指标量化评估。
• 温度影响不可忽视：在极端温度环境下飞行前，应让飞控充分预热并静止初始化。
• 磁干扰需警惕：合理布局电子设备，避免大电流导线靠近磁力计。
• 参数调整要谨慎：修改滤波器截止频率时，应结合频谱分析结果，避免过度滤波导致信号延迟。