外观
踩坑Robotics Stack Exchange2019-04-06
四旋翼加速度计积分定高导致持续爬升
本文由 AI 根据公开内容整理，可能有误，请以原文为准：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气压计被回答中提及。
解决办法
- 不要用加速度计积分结果直接做高度状态估计或控制，因为测量噪声会累积且无法自行校正。
- 若使用IMU加速度，应从测量值中减去重力向量，而不是只依赖静止平均得到的常量偏置。
- 快速可行方案：将声呐高度测量通过合适截止频率的低通滤波后用于高度控制；20Hz对定高通常足够。
- 控制律可加入悬停油门抵消重力，再用PD形式的“虚拟弹簧-阻尼”跟踪目标高度，并按期望阻尼比和自然频率选择
k_p、k_d。 - 若要融合传感器，可写Kalman滤波器：加速度计用于预测，超声波和/或气压计用于校正。
原问题作者：user123456098；采纳答案作者：holmeski。原内容依 CC BY-SA 4.0 授权，本页摘要同样依 CC BY-SA 4.0 授权。
来源
本页事实对应的公开页面，以原文为准。