# 四旋翼加速度计积分定高导致持续爬升

> 原文链接：https://robotics.hellobike.com/pitfalls/2019-04-06-robotics-se-9456
> 频道：pitfalls | 更新日期：2019-04-06 | 标签：auto, stackexchange, quadcopter, control, pid, raspberry-pi
> 核心摘要：加速度计积分会因噪声和重力残差漂移，建议不用其直接定高，改用低通后的声呐并设计PD控制。

# 四旋翼加速度计积分定高导致持续爬升

::: v-pre
> 本文由 AI 根据公开内容整理，可能有误，请以原文为准：[How can we use the accelerometer for altitude estimation?](https://robotics.stackexchange.com/questions/9456/how-can-we-use-the-accelerometer-for-altitude-estimation)（Robotics Stack Exchange #9456）

**状态**：已解决

## 问题

室内四旋翼用HC-SR04声呐做高度P控制会约50cm振荡；尝试用加速度计Z轴扣除重力偏置并积分，仍有如-0.0034的负加速度残差，导致飞行器持续爬升。

## 环境

自主四旋翼；室内飞行；HC-SR04超声波传感器，20Hz、0.3cm分辨率；加速度计；Pixhawk气压计被回答中提及。

## 解决办法

1. 不要用加速度计积分结果直接做高度状态估计或控制，因为测量噪声会累积且无法自行校正。
2. 若使用IMU加速度，应从测量值中减去重力向量，而不是只依赖静止平均得到的常量偏置。
3. 快速可行方案：将声呐高度测量通过合适截止频率的低通滤波后用于高度控制；20Hz对定高通常足够。
4. 控制律可加入悬停油门抵消重力，再用PD形式的“虚拟弹簧-阻尼”跟踪目标高度，并按期望阻尼比和自然频率选择`k_p`、`k_d`。
5. 若要融合传感器，可写Kalman滤波器：加速度计用于预测，超声波和/或气压计用于校正。

原问题作者：user123456098；采纳答案作者：holmeski。原内容依 CC BY-SA 4.0 授权，本页摘要同样依 CC BY-SA 4.0 授权。
:::

## 原始参考来源 (Sources)

- [Robotics Stack Exchange #9456：How can we use the accelerometer for altitude estimation?](https://robotics.stackexchange.com/questions/9456/how-can-we-use-the-accelerometer-for-altitude-estimation)