第4章角速度环控制基础

4、角速度环控制基础：角速度环的作用、P（比例）控制原理、角速度环的数学模型

各位同学，欢迎来到角速度环的世界。

说实话，飞控系统里最核心、最底层的控制环，就是角速度环。你想想看，不管你是做航拍、穿越机还是行业无人机，最终执行机构（电机）输出的，就是让飞机绕某个轴转起来。角速度环，就是管这个「转」的。

我个人习惯把角速度环比作飞机的「本能反应」。它不需要思考「我要飞到哪」，它只关心一件事：我转得快不快？我要不要转慢点？

角速度环到底在干什么？说白了，它就是一个「速度调节器」。

举个例子。你遥控器打杆，想让飞机向右滚转30度。外层的角度环会算出来：「嗯，我需要一个每秒100度的滚转角速度。」然后这个指令就传给了角速度环。

角速度环接到指令后，会立刻对比：

如果当前值小于目标值，它就加大油门差，让飞机转得更快。如果当前值已经达到了，它就维持住。如果转过了，它就反向刹车。

核心作用一句话：角速度环负责让飞机的实际角速度，紧紧跟随你期望的角速度指令。

我在项目中遇到过一个问题：有次调试一架大轴距的测绘无人机，发现飞机在悬停时总是轻微抖动。查了半天，发现是角速度环的响应太慢了，导致外环（角度环）一直在「追」内环的滞后。嗯，这里要注意：角速度环的响应速度，直接决定了整架飞机的操控手感。

角速度环最基础的控制方式，就是P控制。也就是比例控制。

它的数学表达式很简单：

输出 = Kp × (目标角速度 - 当前角速度)

这个公式里：

你想想看，如果误差很大（比如你突然猛打杆），输出就很大，电机立刻猛推。如果误差很小（接近目标了），输出就变小，电机温柔地微调。

这就是P控制的本质：误差越大，出力越大。

个人经验：我刚开始调飞控时，总觉得Kp越大越好，响应快嘛。结果有一次在室内试飞，Kp调得太高，飞机像抽风一样高频抖动，差点撞墙。后来我才明白，P控制有个天生的缺陷——它只能「跟着误差走」，永远消除不了稳态误差。

为什么会这样？因为当误差趋近于零时，输出也趋近于零。如果这时候有外部扰动（比如一阵风），飞机就会偏离目标，产生一个新的小误差，P控制器再去纠正。所以纯P控制下，飞机总是「慢半拍」。

不过，对于角速度环来说，纯P控制其实已经能应付大部分场景了。因为角速度环的响应速度很快，误差积累的时间很短。很多入门级的飞控，角速度环只用P就够用。

要真正理解角速度环，我们得看看它的数学模型。别怕，不复杂。

首先，飞机的转动遵循刚体动力学方程：

J × α = τ

其中：

角加速度α，就是角速度ω的变化率。所以：

J × dω/dt = τ

现在，我们把P控制器的输出作为力矩指令：

τ = Kp × (ω_desired - ω_actual)

代入动力学方程：

J × dω/dt = Kp × (ω_desired - ω_actual)

整理一下：

dω/dt = (Kp / J) × (ω_desired - ω_actual)

这个方程告诉我们什么？

避坑指南：我曾经犯过一个错误——在不同机型上用了同一套Kp参数。结果小飞机抖得像筛子，大飞机反应迟钝。后来我才意识到，Kp必须根据飞机的转动惯量来调整。大飞机需要更大的Kp才能获得相同的响应速度。

我们再看一个更完整的模型，包含阻尼项（空气阻力、轴承摩擦等）：

J × dω/dt = Kp × (ω_desired - ω) - B × ω

这里的B是阻尼系数。阻尼项-B×ω，相当于一个「天然的微分器」，它会阻止角速度的变化。阻尼越大，飞机越「稳」，但也越「肉」。

所以，角速度环的数学模型可以总结为：

在实际工程中，我们通常不会去精确测量J和B。而是通过试凑法（或者叫「调参大法」）来找到合适的Kp。但理解这个模型，能帮你少走很多弯路。

总结一下：

下一章，我们会深入角速度环的调优实战。我会手把手教你如何用示波器看响应曲线，如何判断Kp是偏大还是偏小。嗯，到时候你会觉得，调参其实挺有意思的。