078、自动起飞控制算法

飞控算法从入门到精通 | 078 自动起飞控制算法

从一次炸机说起

去年夏天，我在测试一款四旋翼的自动起飞功能。地面站显示一切正常，GPS锁星12颗，气压计校准通过，磁罗盘偏差在合理范围。我按下“自动起飞”按钮，飞机缓缓离地——然后，在离地约30厘米处，突然向左前方猛冲，螺旋桨削到水泥地，当场断了两根桨。

事后复盘，问题出在起飞阶段的控制逻辑上。当时我用的是一套“简单粗暴”的方案：检测到油门超过某个阈值，就切换到位置控制模式。但问题在于，飞机刚离地时，GPS和气压计的数据噪声极大，位置估计本身就不准，再加上地面效应导致升力非线性变化，位置控制器一介入，直接给了错误的修正量，飞机就“跑偏”了。

从那以后，我花了整整两周重写自动起飞逻辑。今天这篇笔记，就是那次炸机换来的经验。

自动起飞的核心矛盾

自动起飞算法要解决的根本问题，是从“地面约束状态”到“自由飞行状态”的平滑过渡。这个过程中，飞机经历了三个物理状态的变化：

1. 地面静止：机体完全由起落架支撑，螺旋桨产生的升力小于重力
2. 离地瞬间：升力刚刚克服重力，但地面效应显著，气动特性突变
3. 爬升阶段：完全脱离地面效应，进入自由飞行

每个阶段对控制器的要求完全不同。地面阶段需要的是“力控”——精确控制推力大小；离地瞬间需要“阻尼”——抑制姿态扰动；爬升阶段则需要“位置控”——维持航迹。