3、加速度计原理：加速度计测量比力、静态姿态估计（横滚角、俯仰角）的计算公式、误差来源（噪声、振动、重力偏差）
加速度计是无人机姿态估计中最基础的传感器之一。它通过测量物体受到的比力（Specific Force）来感知加速度与重力场的关系，从而在静态或准静态条件下估算无人机的横滚角（Roll）与俯仰角（Pitch）。理解加速度计的工作原理、静态姿态解算公式以及误差来源，是后续融合陀螺仪数据、构建时序模型（如互补滤波或卡尔曼滤波）的前提。本章将围绕这三个核心问题展开，并结合实际工程场景给出可操作的判断方法与调参建议。
3.1 加速度计测量比力的物理原理
加速度计的核心是一个质量-弹簧-阻尼系统。当加速度计壳体随无人机加速运动时，内部检测质量块因惯性产生相对位移，该位移被电容或压阻式检测电路转换为电信号。然而，加速度计输出的并不是纯粹的物体运动加速度，而是比力，即单位质量上除重力以外的合外力。用公式表达为：
f = a - g其中，f 为加速度计输出的比力向量（m/s²），a 为物体在惯性系中的真实加速度，g 为重力加速度向量（约 9.81 m/s²，方向竖直向下）。在无人机机体坐标系中，当无人机悬停或缓慢移动时，真实加速度 a 接近于零，此时加速度计测量的比力近似等于 -g，即重力在机体轴上的投影。正是这一特性，使得加速度计能够作为“重力方向传感器”来估计姿态。
3.2 静态姿态估计：横滚角与俯仰角计算公式
在无人机静止或匀速直线运动时，设机体坐标系为 O-XYZ（X 轴指向机头，Y 轴指向右翼，Z 轴垂直机体向下），加速度计三轴输出分别为 ax、ay、az。由于此时 a ≈ 0，有：
[ax, ay, az]ᵀ ≈ -g · R · [0, 0, 1]ᵀ其中 R 为机体坐标系到导航坐标系的旋转矩阵。经过推导，可以得到横滚角 φ（Roll）和俯仰角 θ（Pitch）的计算公式：
Roll = atan2(ay, az)
Pitch = atan2(-ax, sqrt(ay² + az²))这里使用 atan2 函数而非普通反正切，是为了处理角度象限问题，保证输出范围在 -180° 到 180° 之间。需要注意的是，该公式无法估计偏航角（Yaw），因为重力方向与 Z 轴旋转对称，加速度计对绕重力轴的旋转不敏感。
| 姿态角 | 公式 | 有效范围 | 适用条件 |
|---|---|---|---|
| 横滚角 φ | atan2(ay, az) | -180° ~ 180° | 静态/准静态，无水平加速度 |
| 俯仰角 θ | atan2(-ax, √(ay²+az²)) | -90° ~ 90° | 静态/准静态，无垂直加速度 |
| 偏航角 ψ | 不可观测 | — | 需磁力计或视觉/卫星辅助 |
3.3 误差来源深度剖析
加速度计在实际工程应用中面临多种误差，这些误差会直接污染姿态解算结果。主要误差源包括：
- 测量噪声（白噪声）：由传感器内部电路热噪声、量化噪声等引起，表现为高频随机抖动。典型噪声密度为 100-300 μg/√Hz，在静止状态下输出波形呈毛刺状。
- 振动耦合：无人机电机、螺旋桨高速旋转产生的机械振动（通常为 100-500 Hz）会通过机架传导至加速度计，造成输出信号叠加周期性干扰。严重时会导致姿态角估计出现数度偏差。
- 重力偏差（零偏与标定误差）：加速度计出厂时存在零偏（bias）和比例因子误差（scale error）。例如，Z 轴零偏若为 0.05g，则会导致俯仰角估计偏差约 2.86°。此外，安装时轴间非正交也会引入交叉耦合误差。
- 动态加速度干扰：无人机加减速、转弯时产生的线加速度和向心加速度会混入比力信号，使加速度计误判重力方向。这是加速度计在动态场景下最大的误差来源。
3.4 实战案例：四旋翼悬停姿态抖动排查
背景与约束：某四旋翼无人机在悬停时，飞控日志显示加速度计估计的横滚角在 ±3° 范围内高频抖动，导致电机转速波动明显，续航下降约 8%。该机采用 10 寸螺旋桨、电机 KV 值 920，飞控安装于中心板上方，未使用减震垫。
初始现象与数据：通过地面站记录加速度计原始数据，发现 X 轴输出在 0.02g 附近波动，频谱分析显示在 180 Hz 和 320 Hz 处有明显峰值，对应电机转速（约 5400 RPM）及其倍频。同时，姿态解算后的 Roll 角标准差达到 1.8°。
分析判断过程：首先排除传感器本身故障，将飞控置于静止桌面，输出正常（标准差 < 0.05°）。随后进行地面怠速测试，发现随油门增加，振动幅值线性增大，确认振动源为电机-螺旋桨系统。进一步检查飞控安装，发现中心板为碳纤维硬板，无任何隔振措施，振动直接传递至 IMU。
实际操作步骤：
- 在飞控与机架之间增加 3mm 硅胶减震球，降低高频振动传递。
- 在飞控固件中启用加速度计低通滤波器，截止频率设为 50 Hz（原为 100 Hz）。
- 针对 180 Hz 振动峰，增加一个数字陷波器（Notch Filter），品质因数 Q=10。
- 重新进行六面静态标定，消除零偏和比例因子误差。
结果对比：改装后，悬停时 Roll 角标准差从 1.8° 降至 0.3°，电机转速波动减小，续航恢复至正常水平。频谱分析显示 180 Hz 和 320 Hz 峰值衰减超过 80%。
风险与代价：增加减震球后，飞控在剧烈机动时可能出现轻微共振，需通过飞行测试验证。低通滤波截止频率降低会引入约 20ms 的相位延迟，对快速姿态响应有一定影响，需配合陀螺仪融合参数调整。
复盘经验：加速度计振动问题应优先从机械减震入手，而非单纯依赖软件滤波。软件滤波只能抑制已耦合的振动，但会牺牲信号带宽。同时，定期执行加速度计标定是保证姿态精度的基础。
3.5 常见误区与总结复盘
在加速度计使用中，工程师常犯以下错误：
- 误区一：认为加速度计在任何飞行状态下都能准确估计姿态。实际上，动态加速度干扰是不可避免的，必须与陀螺仪融合。
- 误区二：忽略标定直接使用出厂参数。不同温度、不同批次传感器的零偏差异可达 0.1g，对应姿态误差约 5.7°。
- 误区三：过度依赖低通滤波。截止频率过低会导致姿态响应迟钝，在穿越机等高速飞行场景中引发失控风险。
- 误区四：将加速度计安装在振动节点上。应选择机架重心附近、振动最小的位置，并使用减震装置。