4. 角速度环调参：角速度环的作用、P增益与D增益的物理意义、手动调参步骤
各位好，欢迎来到第四章。前几章我们把飞控的整体架构和传感器校准聊完了，从这一章开始，咱们正式进入「调参实战」的核心区。
角速度环，也叫内环、速率环。你想想看，飞控里所有的姿态控制、位置控制，最终都要落到角速度环上。它要是没调好，外环再努力也是白搭。我在项目里见过太多人上来就调位置环，结果飞机乱晃，其实就是内环没锁住。
4.1 角速度环到底在干什么？
说白了，角速度环的任务就一个：让飞机的实际角速度，老老实实跟着你的期望角速度走。
你遥控器打杆，或者飞控自己算出一个期望的滚转角速度，比如 200°/s。角速度环就要去算：现在实际角速度是多少？差了多少？该给电机多大的力才能追上这个目标？
它是个典型的 PID 闭环。但在实际飞控里，我们通常只用 P 和 D，I 项用得很少，甚至不用。为什么？因为角速度环的响应要快，I 项积分容易引入滞后和超调，反而坏事。
核心理解：角速度环是飞控里响应最快的环，它的带宽决定了整个飞行器的机动性和稳定性上限。外环（姿态环、位置环）的响应速度，永远不能超过内环。
我习惯把角速度环比作「汽车的悬挂系统」。悬挂硬，路感清晰，但颠簸；悬挂软，舒服，但过弯侧倾大。角速度环的 P 和 D，就是在调这套悬挂的软硬。
4.2 P 增益的物理意义
P 增益，比例增益。它的物理意义很直接：你期望角速度和实际角速度之间的误差，乘以 P，就是你要输出的控制力。
举个例子：
- 期望角速度 200°/s，实际 100°/s，误差 100°/s
- P = 0.15，那么输出 = 100 × 0.15 = 15% 的油门修正量
P 越大，对误差的反应越猛。但 P 太大，飞机会抖，像弹簧一样来回震荡。我在调试一架 250mm 穿越机时，P 给到 0.25，飞机在地上就开始高频抖动，电机发烫，那就是 P 过冲了。
我的经验：P 的初始值可以从 0.08 开始试。对于 250-450mm 的常见四轴，P 通常在 0.08-0.20 之间。轴距越大，P 可以适当小一点。
4.3 D 增益的物理意义
D 增益，微分增益。它的作用是预测误差的变化趋势，提前施加反向力来抑制震荡。
你想想看，如果只有 P，飞机接近目标角速度时，误差变小，P 的输出也变小。但飞机有惯性，它会冲过头。这时候 D 就起作用了——它看的是误差的变化率。如果误差正在快速减小（说明快到了），D 会输出一个反向力，让飞机「刹车」，避免超调。
D 的物理意义就是阻尼。D 越大，阻尼越强，飞机越「稳」，但反应也越「肉」。D 太小，飞机容易 overshoot，来回晃几下才稳住。
注意：D 对噪声非常敏感。因为微分放大了高频噪声。如果你发现电机在高频吱吱响，或者飞控日志里角速度曲线毛刺很多，很可能是 D 太大了。我曾经在调试一台六轴时，D 给到 0.008，结果电机直接啸叫，降下来才正常。
D 的取值通常比 P 小一个数量级。比如 P=0.15，D 可能在 0.002-0.006 之间。
4.4 P 和 D 的配合关系
P 和 D 不是孤立的，它们是一对搭档。我画了一张图，帮你理解它们的关系：
从图上你能看到：P 和 D 要匹配。P 大了，D 也要跟着大一点，否则压不住震荡。P 小了，D 太大，飞机就像陷在泥里，反应迟钝。
4.5 手动调参步骤
好了，理论讲完了，咱们上手。下面是我在实际项目中反复验证的一套调参流程，你照着做，基本不会翻车。
步骤一：准备工作
- 确保飞机已经完成传感器校准（加速度计、陀螺仪、磁力计）
- 确保遥控器行程、模式开关设置正确
- 拆掉螺旋桨！拆掉螺旋桨！拆掉螺旋桨！重要的事说三遍
- 连接地面站，打开角速度日志记录（至少 100Hz）
安全警告：调角速度环时，飞机可能会突然剧烈抖动。一定要拆桨，或者把飞机固定好。我曾经有一次没拆桨，P 给大了，飞机直接在地上翻了个跟头，差点打到人。
步骤二：初始值设定
把所有轴的 P 和 D 设为保守值。我常用的初始值：
| 参数 | 滚转 (Roll) | 俯仰 (Pitch) | 偏航 (Yaw) |
|---|---|---|---|
| P | 0.10 | 0.10 | 0.15 |
| D | 0.003 | 0.003 | 0.005 |
| I | 0.00 | 0.00 | 0.00 |
偏航的 P 通常比滚转和俯仰大一些，因为偏航轴的转动惯量不同。
步骤三：调 P——找到震荡边界
- 把飞机拿在手里（或者放在软垫上），轻轻晃动，感受响应
- 每次增加 P 0.01-0.02，然后快速打杆或晃动飞机，观察回中情况
- 当飞机开始出现持续的高频震荡（像音叉一样嗡嗡响），记录此时的 P 值，记为 P_max
- 将 P 设为 P_max 的 60%-70%
举个例子：你在滚转轴加到 P=0.18 时，飞机开始抖，那么 P 就取 0.18 × 0.65 ≈ 0.12。
小技巧：用手感受比看日志更直观。飞机在你手里抖了，那就是 P 到边界了。但注意，别让飞机共振太久，容易损坏电机或飞控。
步骤四：调 D——消除超调
- 保持 P 不变，从 D=0.002 开始
- 快速打杆然后回中，观察飞机是否 overshoot（冲过头再回来）
- 每次增加 D 0.001，直到 overshoot 消失，回中干脆利落
- 如果 D 太大，飞机会变得「肉」，打杆反应慢，此时减小 D
我一般调 D 时，会盯着日志里的角速度曲线看。理想的曲线是：阶跃响应上升快，没有超调，或者只有一点点超调（<5%），然后平滑收敛。
步骤五：三个轴分别调
滚转、俯仰、偏航要分开调。因为三个轴的转动惯量不同，参数不会一样。我习惯先调滚转，再调俯仰，最后调偏航。
俯仰轴通常和滚转轴参数接近，但偏航轴差异较大。偏航的 D 可以适当大一些，因为偏航的阻尼天生就小。
步骤六：装桨试飞验证
装桨后，悬停测试：
- 飞机是否稳定？有没有低频晃动？
- 快速打杆，响应是否跟手？有没有延迟？
- 松杆后，飞机是否快速回平？有没有 overshoot？
如果悬停时飞机轻微晃动，可以适当增加 D 0.001-0.002。如果打杆反应慢，可以适当增加 P 0.01-0.02。
最终目标：角速度环调好后，飞机应该像「钉」在空中一样。打杆即动，松杆即停。没有抖动，没有延迟，没有 overshoot。
4.6 常见问题与避坑
调了这么多年，我踩过的坑不少。给你列几个最常见的：
- 电机发烫：通常是 D 太大，或者 P 太大导致高频震荡。先降 D，再降 P。
- 悬停时低频晃动：P 太小，或者 D 太大导致响应慢。适当增加 P。
- 打杆后飞机回中慢：D 太大，阻尼过强。减小 D。
- 飞机在地上抖，拿起来不抖：可能是地面效应或者桨平衡问题，先检查桨，再调参。
我曾经踩过的坑：有一次调一台 550mm 的测绘机，怎么调都抖。折腾了两天，最后发现是飞控减震棉太软，陀螺仪在共振。换了硬减震棉，问题立刻解决。所以，调参之前，先确认硬件没问题。
好了，角速度环的调参就这些。记住：P 决定响应速度，D 决定阻尼。先调 P 到边界，再加 D 消除震荡。三个轴分开调，装桨后验证。这套流程走下来，你的内环基本就稳了。