第3章三环控制原理

三环控制原理：位置环、速度环、电流环的物理意义与数学模型

做伺服驱动这些年，我见过不少工程师一上来就调参数，结果越调越乱。为什么？说白了，就是没搞懂三环到底在干什么。

三环控制，是伺服驱动的灵魂。电流环、速度环、位置环，三个环层层嵌套。你想想看，就像三个领导管一件事——最里面的管得最细，最外面的管得最宏观。今天我就把这三个环的物理意义和数学模型，掰开了讲清楚。

电流环是三个环里响应最快的。它的任务很简单：让电机实际电流，老老实实跟着你给的电流指令走。

物理意义：电流就是力矩。你让电机出多大力，电流环就得把这个力控制住。我在现场遇到过一台设备，运行时总是抖动，查了半天，发现是电流环带宽设得太低，力矩跟不上指令变化。嗯，这里要注意，电流环带宽不够，电机就像没吃饱饭的人，干活没力气还发抖。

数学模型：电流环的核心是PI控制器。传递函数可以写成：

G_i(s) = Kp_i + Ki_i / s

其中Kp_i是比例增益，Ki_i是积分增益。电流环的闭环传递函数，一般简化成一阶惯性环节：

G_cl_i(s) = 1 / (T_i * s + 1)

T_i是电流环等效时间常数，一般在0.1ms到1ms之间。你调电流环时，主要就是调Kp_i和Ki_i，让电流响应又快又稳。

我的经验：电流环的Ki_i不要设太大，否则容易引起震荡。我习惯先调Kp_i，让电流响应速度达到要求，再慢慢加Ki_i消除静差。

速度环在电流环外面。它给电流环发指令，让电机转速保持在你想要的值上。

物理意义：速度环决定了电机的加减速性能。你想想看，一个电梯要平稳启动、匀速运行、准确停止，全靠速度环在中间协调。我记得有一次调试印刷机，速度环参数没整好，机器一加速就过冲，纸都拉断了。后来把速度环带宽降下来，问题就解决了。

数学模型：速度环的传递函数，是在电流环的基础上再加一个PI控制器：

G_v(s) = Kp_v + Ki_v / s

速度环的闭环传递函数，通常可以近似为：

G_cl_v(s) = 1 / (T_v * s + 1)

T_v是速度环等效时间常数，一般在5ms到20ms之间。速度环的带宽，决定了系统能跟踪多快的速度变化。

  关键点：速度环的带宽，一般要设成电流环带宽的1/5到1/10。为什么？因为外环不能比内环快，否则内环跟不上外环的指令，系统就会震荡。

位置环在最外面。它给速度环发指令，让电机精确停在目标位置上。

物理意义：位置环决定了定位精度和跟随误差。你想想看，数控机床要加工一个零件，位置环不好，加工出来的尺寸就不对。我见过一个案例，客户说他们的机械手总是抓不准位置，我一看，位置环的增益设得太低，跟随误差太大。调高增益后，精度立马就上来了。

数学模型：位置环一般只用比例控制，不用积分：

G_p(s) = Kp_p

位置环的闭环传递函数：

G_cl_p(s) = Kp_p / (s + Kp_p)

Kp_p就是位置环增益，单位是1/s。它的倒数，就是位置环的时间常数。位置环的带宽，一般设成速度环带宽的1/5到1/10。

注意：位置环加积分容易引起超调和震荡。我一般只在需要消除稳态位置误差时才加一点点积分，而且积分限幅要设得很小。

三个环串在一起，带宽怎么分配？这是现场调试的核心问题。我总结了一个原则，叫“内快外慢”。

为什么内环要快？ 因为外环的指令，要靠内环去执行。内环响应慢了，外环的指令就执行不到位，整个系统就会震荡。

带宽分配的经验值：

这个比例不是死规矩。我曾经调试一台高速贴片机，机械刚性特别好，就把速度环带宽提到了电流环的1/3，效果反而更好。你想想看，机械系统越硬，带宽就可以越接近。

避坑指南：我曾经遇到过一台设备，三环带宽都设得很高，结果一运行就尖叫。后来发现是机械共振。解决办法是把速度环带宽降下来，或者加一个陷波滤波器。记住，带宽不是越高越好，够用就行。

下面这张图，是我自己画的三环控制结构图。你看一眼，就能明白三个环是怎么串在一起的。

你看，从位置环到速度环，再到电流环，一层包一层。电流环在最里面，响应最快；位置环在最外面，响应最慢。这就是“内快外慢”的物理实现。

  总结一下：三环控制的本质，就是把一个复杂的运动控制问题，分解成三个层次来解决。电流环管力矩，速度环管转速，位置环管定位。每个环各司其职，带宽分配合理，系统才能稳定可靠。

现场调试时，我习惯从内往外调。先把电流环调稳，再调速度环，最后调位置环。这样一层层往上走，出了问题也容易定位。你试试看，按照这个思路来，三环整定其实没那么复杂。