飞控算法从入门到精通 · 080 | 悬停控制算法与精度优化
一、从一次“炸机”说起
去年夏天，我在一个农业植保项目上调试六旋翼。GPS信号良好，气压计校准通过，磁罗盘也做了硬磁补偿。上电解锁，推油到悬停点，飞机稳稳地定在了2米高度。我心想，这PID参数调得不错，可以收工了。结果一阵侧风过来，飞机开始左右晃动，幅度越来越大，最后直接侧翻——炸了。
事后复盘，问题出在悬停控制算法上。当时用的是最基础的串级PID，外环位置环、内环姿态环，参数是在无风环境下调的。风一来，外环积分项饱和，内环响应跟不上，整个系统就失稳了。这件事让我意识到：悬停控制不是“调好一组PID”就完事的，它涉及传感器融合、控制分配、抗饱和、前馈补偿等一系列工程细节。
二、悬停控制的核心矛盾
悬停的本质是让飞行器在三维空间中保持位置和姿态不变。听起来简单，但实际面临两个矛盾：
矛盾一：传感器噪声 vs 控制精度
GPS在静态时有米级漂移，气压计受气流扰动影响，IMU有零偏和温漂。你拿这些带噪声的数据去算控制量，结果就是飞机在悬停点附近“哆嗦”。调低增益吧，抗风能力差；调高增益吧，高频抖动加剧。
矛盾二：响应速度 vs 稳定性
悬停时，外环（位置环）的更新频率通常只有10-20Hz，内环（姿态环）在200-400Hz。外环算出一个目标姿态，内环去跟踪。如果外环输出变化太快，内环来不及响应，就会产生相位滞后，导致震荡。反过来，外环输出太慢，抗风扰动又不行。
