4. 抗风控制核心概念

好，咱们进入角速度环的调参实战。这是整个姿态控制里最核心的一环，也是我最喜欢跟人较劲的地方。

为什么这么说？因为角速度环是飞控响应风扰的第一道防线。外层的角度环还在慢悠悠算误差呢，角速度环已经直接怼上去了。说白了，抗风性能好不好，角速度环占七成功劳。

4.1 角速度环在抗风中的角色

先理清一个概念。无人机被风吹歪了，谁先感知到？是陀螺仪。陀螺仪测到的是角速度，不是角度。所以风一吹，角速度环第一个跳出来干活。

我习惯把角速度环比作「保安队长」。风来了就是有人推你，保安队长得立刻顶住，不能等领导（角度环）下命令再动手。等角度环算完，飞机可能已经翻了。

咱们来看一个实际场景。悬停时突然来一阵侧风，飞机开始侧倾。陀螺仪测到滚转角速度，角速度环立刻输出控制量让电机差速转动，产生反向力矩对抗风扰。这个过程必须在几十毫秒内完成。

4.2 P增益的物理意义与响应特性

角速度环的P增益，说白了就是「对抗角速度的力度」。公式很简单：

输出 = P × (目标角速度 - 实际角速度)

悬停时目标角速度是0，所以输出 = -P × 实际角速度。风越大，实际角速度越大，输出就越大。

P增益调大，效果立竿见影：

• 响应更快——风刚吹到，飞机立刻顶回去
• 抗风刚度更高——同样风扰下，姿态偏移更小
• 但震荡风险也更高——过冲、回摆、甚至发散

我遇到过最典型的案例：一个做测绘的客户，飞机在6级风里悬停，滚转角晃了±8度。他上来就把P增益翻了一倍，结果飞机开始高频抖动，图传画面全是果冻纹。这就是典型的P过大导致的震荡边界问题。

4.3 震荡边界的物理机制

为什么会震荡？因为系统有惯性，有延迟。电机响应需要时间，螺旋桨升力变化需要时间，陀螺仪采样也有延迟。P增益太大，相当于你推门的力气太大，门撞到墙又弹回来，你看到弹回来又推一把，结果门就在那来回晃。

震荡边界就是系统从「稳定收敛」变成「等幅震荡」的那个临界点。过了这个点，就是发散。

我一般把震荡分为三个阶段：

阶段	表现	P增益状态
欠阻尼	风扰后回中快，但有一两次过冲	偏小，可继续增大
临界阻尼	回中干脆，几乎无过冲	理想值附近
过阻尼/震荡	高频抖动，或低频摇摆	过大，需减小

嗯，这里要注意：临界阻尼是理想状态，但实际调参时我们往往留一点余量，让系统稍微偏欠阻尼。为什么？因为电池电压下降、重心偏移等变化会让系统往震荡方向漂移，留点余量更安全。

4.4 实战调参步骤：找P的震荡边界

下面是我个人习惯的调参流程，在几十个项目里验证过。你可以在仿真里先跑，也可以在真机上小心操作。

1. 初始值设定——从经验值开始。对于250mm轴距左右的四轴，滚转和俯仰的P通常在0.08-0.15之间。偏航可以小一些，0.05-0.10。
2. 逐步增大P——每次增加10%-20%。悬停观察，用手轻推飞机模拟风扰。
3. 找到震荡点——当飞机出现持续高频抖动（肉眼可见的震颤），记录当前P值。
4. 回退60%-70%——震荡边界的P值记为P_max，最终使用的P = P_max × 0.6 ~ 0.7。

我曾经在调试一架六轴物流机时，按这个流程把P从0.12调到0.22才出现震荡。回退到0.15后，抗风性能比之前提升了将近一倍。但注意，不同飞机的「手感」差异很大，别死记数值。

4.5 角速度环P增益调参知识体系

下面这张图是我自己整理的调参思维框架，帮你把零散的知识串起来：

4.6 避坑指南与常见误区

调了这么多年，我踩过的坑不少。挑几个典型的说说：

• 别在风大的时候调参——风本身是扰动，你分不清抖动是风引起的还是P太大引起的。我习惯在无风或微风环境里调，调好了再出去抗风测试。
• 别只看悬停——有些飞机悬停时稳得很，一飞起来就抖。因为前飞时气流扰动更大，角速度环的负载变了。我建议悬停调好后，再飞个8字航线验证一下。
• 注意电池电压——满电和亏电时，电机响应速度不一样。我曾经在满电时调好参数，飞了3分钟开始抖，差点炸机。现在我都用半电状态做最终验证。