4. 角速度环调参(上):P增益对风扰的快速响应与震荡边界
好,咱们进入角速度环的调参实战。这是整个姿态控制里最核心的一环,也是我最喜欢跟人较劲的地方。
为什么这么说?因为角速度环是飞控响应风扰的第一道防线。外层的角度环还在慢悠悠算误差呢,角速度环已经直接怼上去了。说白了,抗风性能好不好,角速度环占七成功劳。
4.1 角速度环在抗风中的角色
先理清一个概念。无人机被风吹歪了,谁先感知到?是陀螺仪。陀螺仪测到的是角速度,不是角度。所以风一吹,角速度环第一个跳出来干活。
我习惯把角速度环比作「保安队长」。风来了就是有人推你,保安队长得立刻顶住,不能等领导(角度环)下命令再动手。等角度环算完,飞机可能已经翻了。
核心认知:角速度环的响应速度,直接决定了无人机在阵风下的姿态波动幅度。P增益越大,顶得越狠,但也越容易把自己晃倒。
咱们来看一个实际场景。悬停时突然来一阵侧风,飞机开始侧倾。陀螺仪测到滚转角速度,角速度环立刻输出控制量让电机差速转动,产生反向力矩对抗风扰。这个过程必须在几十毫秒内完成。
4.2 P增益的物理意义与响应特性
角速度环的P增益,说白了就是「对抗角速度的力度」。公式很简单:
输出 = P × (目标角速度 - 实际角速度)
悬停时目标角速度是0,所以输出 = -P × 实际角速度。风越大,实际角速度越大,输出就越大。
P增益调大,效果立竿见影:
- 响应更快——风刚吹到,飞机立刻顶回去
- 抗风刚度更高——同样风扰下,姿态偏移更小
- 但震荡风险也更高——过冲、回摆、甚至发散
我遇到过最典型的案例:一个做测绘的客户,飞机在6级风里悬停,滚转角晃了±8度。他上来就把P增益翻了一倍,结果飞机开始高频抖动,图传画面全是果冻纹。这就是典型的P过大导致的震荡边界问题。
4.3 震荡边界的物理机制
为什么会震荡?因为系统有惯性,有延迟。电机响应需要时间,螺旋桨升力变化需要时间,陀螺仪采样也有延迟。P增益太大,相当于你推门的力气太大,门撞到墙又弹回来,你看到弹回来又推一把,结果门就在那来回晃。
震荡边界就是系统从「稳定收敛」变成「等幅震荡」的那个临界点。过了这个点,就是发散。
注意:震荡边界不是固定值。它跟飞机惯量、电机响应速度、螺旋桨尺寸、甚至电池电压都有关系。同一组P值,换块旧电池可能就震荡了。
我一般把震荡分为三个阶段:
| 阶段 | 表现 | P增益状态 |
|---|---|---|
| 欠阻尼 | 风扰后回中快,但有一两次过冲 | 偏小,可继续增大 |
| 临界阻尼 | 回中干脆,几乎无过冲 | 理想值附近 |
| 过阻尼/震荡 | 高频抖动,或低频摇摆 | 过大,需减小 |
嗯,这里要注意:临界阻尼是理想状态,但实际调参时我们往往留一点余量,让系统稍微偏欠阻尼。为什么?因为电池电压下降、重心偏移等变化会让系统往震荡方向漂移,留点余量更安全。
4.4 实战调参步骤:找P的震荡边界
下面是我个人习惯的调参流程,在几十个项目里验证过。你可以在仿真里先跑,也可以在真机上小心操作。
- 初始值设定——从经验值开始。对于250mm轴距左右的四轴,滚转和俯仰的P通常在0.08-0.15之间。偏航可以小一些,0.05-0.10。
- 逐步增大P——每次增加10%-20%。悬停观察,用手轻推飞机模拟风扰。
- 找到震荡点——当飞机出现持续高频抖动(肉眼可见的震颤),记录当前P值。
- 回退60%-70%——震荡边界的P值记为P_max,最终使用的P = P_max × 0.6 ~ 0.7。
技巧:用手推飞机时,推一下立刻收手,观察回中过程。如果回中后还晃两下才停,说明P偏大。如果回中很慢、像在泥里游泳,说明P偏小。
我曾经在调试一架六轴物流机时,按这个流程把P从0.12调到0.22才出现震荡。回退到0.15后,抗风性能比之前提升了将近一倍。但注意,不同飞机的「手感」差异很大,别死记数值。
4.5 角速度环P增益调参知识体系
下面这张图是我自己整理的调参思维框架,帮你把零散的知识串起来:
4.6 避坑指南与常见误区
调了这么多年,我踩过的坑不少。挑几个典型的说说:
- 别在风大的时候调参——风本身是扰动,你分不清抖动是风引起的还是P太大引起的。我习惯在无风或微风环境里调,调好了再出去抗风测试。
- 别只看悬停——有些飞机悬停时稳得很,一飞起来就抖。因为前飞时气流扰动更大,角速度环的负载变了。我建议悬停调好后,再飞个8字航线验证一下。
- 注意电池电压——满电和亏电时,电机响应速度不一样。我曾经在满电时调好参数,飞了3分钟开始抖,差点炸机。现在我都用半电状态做最终验证。
警告:如果你发现P增益已经调到很小(比如0.02以下)飞机还在抖,那问题不在角速度环。检查一下机架共振、螺旋桨动平衡、或者陀螺仪滤波参数。别死磕P值。