3. 增稳模式详解：姿态增稳、高度锁定、悬停模式的工作原理与参数调优
各位同学，今天我们聊增稳模式。说白了，这是飞控最核心的“保底”模式。你想想看，无人机在空中，如果没有增稳，那就是一块砖头。我刚开始做飞控调参那会儿，就吃过这个亏——参数没调好，飞机上天就翻，差点砸到人。
增稳模式不是单一模式，它是一套组合拳。我习惯把它拆成三个层次：姿态增稳、高度锁定、悬停。这三个层次一层叠一层，构成了飞控的“安全网”。
核心认知：增稳模式是飞控的“内环”控制。它不关心你要飞去哪里，只关心“飞机当前姿态稳不稳”。所有上层任务（航线、指点飞行）都建立在增稳模式正常工作之上。
3.1 姿态增稳：飞控的“定海神针”
姿态增稳，也叫角速率增稳。它的任务只有一个：让飞机保持你给定的角度。
你遥控器松杆，飞机就应该水平。你推杆，飞机就倾斜，但不会一直翻过去。这就是姿态增稳在干活。
它的工作原理其实不复杂。飞控里有三个传感器：陀螺仪、加速度计、磁力计。陀螺仪测角速度，加速度计测重力方向，磁力计测航向。飞控把这些数据融合，算出当前的姿态角（横滚、俯仰、偏航）。
然后呢？飞控拿这个“当前姿态”和“目标姿态”做差，丢给PID控制器。PID输出控制量，驱动电机，把飞机拉回目标姿态。
我给大家画个流程图，一看就明白。
嗯，这里要注意。姿态增稳的PID参数，尤其是P和D，直接决定了飞机的“手感”。P太大，飞机会抖；P太小，飞机反应迟钝。D是阻尼，用来抑制震荡。
我的调参习惯：先调P，让飞机能回中但不震荡。然后加D，消除过冲。最后调I，消除稳态误差。I不要太大，否则风一吹飞机就晃。
3.2 高度锁定：从“姿态”到“位置”的跨越
姿态增稳只管角度，不管高度。高度锁定，就是在姿态增稳的基础上，再加一个高度环。
高度锁定的核心传感器是气压计。气压计测大气压，换算成海拔高度。但气压计有个毛病——它受温度、风速影响很大。我曾在高原上飞过，气压计直接漂了十几米。
所以现在主流做法是：气压计 + GPS + 超声波/激光测距，多传感器融合。GPS提供绝对高度参考，超声波提供近地精度，气压计提供连续变化趋势。
高度锁定的控制逻辑是这样的：
- 设定目标高度：你切到高度锁定模式时，当前高度就是目标高度。
- 计算高度误差：目标高度 - 当前高度。
- 高度PID控制：输出垂直速度指令。
- 垂直速度PID控制：输出油门指令。
- 油门叠加到姿态增稳的输出上。
你看，这是两层PID串级。外环是高度，内环是垂直速度。为什么要串级？因为直接油门控制高度，响应太慢，而且容易超调。
| 控制层级 | 输入 | 输出 | 典型P值 | 典型I值 |
|---|---|---|---|---|
| 高度外环 | 高度误差 | 目标垂直速度 | 1.0 - 2.0 | 0.1 - 0.3 |
| 垂直速度内环 | 垂直速度误差 | 油门增量 | 0.5 - 1.5 | 0.05 - 0.15 |
避坑指南：我曾经在风大的天气飞，高度锁定模式下飞机上下起伏。后来发现是高度外环的I值太大，积分饱和了。解决办法：限幅积分，或者加前馈补偿。
3.3 悬停模式：增稳的终极形态
悬停模式，说白了就是“定高 + 定点”。它不光锁高度，还锁水平位置。
怎么锁水平位置？靠GPS或者光流。GPS提供经纬度坐标，光流提供相对地面的位移速度。飞控把当前位置和目标位置做差，输出水平速度指令。然后水平速度指令再驱动姿态角，让飞机往目标点飞。
悬停模式的控制结构是三层串级：
- 位置外环：位置误差 → 目标水平速度
- 速度中环：速度误差 → 目标姿态角
- 姿态内环：姿态误差 → 电机控制量
你想想看，这就像你用手托着一个盘子。盘子歪了，你手要动；盘子位置偏了，你身体要动。飞控也是一样的道理。
悬停模式的参数调优，比姿态增稳复杂得多。因为涉及三个环的耦合。我一般按这个顺序调：
- 先调姿态内环（P、D），让飞机姿态响应快且不震荡。
- 再调速度中环（P），让飞机能快速达到目标速度。
- 最后调位置外环（P），让飞机能准确停在目标点。
关键参数表（以PX4为例）：
| 参数名 | 作用 | 推荐范围 | 我的经验值 |
|---|---|---|---|
| MC_ROLLRATE_P | 横滚角速率P | 0.1 - 0.3 | 0.15 |
| MC_ROLLRATE_D | 横滚角速率D | 0.002 - 0.006 | 0.004 |
| MC_PITCHRATE_P | 俯仰角速率P | 0.1 - 0.3 | 0.15 |
| MC_PITCHRATE_D | 俯仰角速率D | 0.002 - 0.006 | 0.004 |
| MC_YAWRATE_P | 偏航角速率P | 0.2 - 0.5 | 0.3 |
| MC_YAWRATE_D | 偏航角速率D | 0.0 - 0.01 | 0.005 |
| MPC_XY_VEL_P | 水平速度P | 1.0 - 3.0 | 2.0 |
| MPC_Z_VEL_P | 垂直速度P | 2.0 - 5.0 | 3.5 |
| MPC_XY_P | 水平位置P | 0.5 - 1.5 | 1.0 |
| MPC_Z_P | 垂直位置P | 0.5 - 1.5 | 1.0 |
3.4 三种模式的对比与选择
我经常被问到：什么时候用姿态增稳？什么时候用悬停？
我的回答是：看任务场景。
| 模式 | 控制维度 | 适用场景 | 风险点 |
|---|---|---|---|
| 姿态增稳 | 角度 | 特技飞行、FPV竞速、手动操控 | 高度会漂，需要手动补油 |
| 高度锁定 | 角度 + 高度 | 航拍、巡检、测绘 | 水平位置会漂，GPS差时更明显 |
| 悬停 | 角度 + 高度 + 位置 | 定点拍照、自动起飞/降落、编队 | GPS信号丢失后失控 |
嗯，这里要特别提醒。悬停模式依赖GPS。如果GPS信号不好，飞机会进入“位置估计不可靠”状态，自动切回高度锁定甚至姿态增稳。所以，做任务规划时，一定要考虑GPS信号覆盖。
我的经验：在桥下、隧道、室内飞，别用悬停模式。老老实实用姿态增稳 + 手动控制。或者加装UWB定位模块，但那是另一门课的内容了。
3.5 参数调优实战：一个案例
我记得有一次，帮客户调一架四轴。客户说飞机悬停时左右晃，像喝醉了酒。我一看日志，发现横滚角速率P值设到了0.35，明显偏大。
我先把P降到0.15，飞机不晃了，但反应变慢。然后加D到0.005，反应速度回来了，也没有震荡。最后微调I到0.1，消除稳态误差。
调完以后，飞机悬停稳得像钉在地上。客户说：“这才叫无人机嘛！”
所以，调参没有捷径。你得理解每个参数的作用，然后根据飞行日志，一步一步调。我建议你们用飞控的调参软件，比如QGroundControl或者Mission Planner，它们有实时曲线显示，能帮你看到参数变化的效果。
最后，送大家一句话：增稳模式是飞控的基石。基石不稳，上层建筑全是空中楼阁。好好理解它，调好它，你的无人机才能飞得稳、飞得准。