一、速度环:承上启下的中环
速度环,我们通常叫它「中环」。为什么叫中环?因为它夹在电流环(内环)和位置环(外环)之间。说白了,它就是个二传手——上面听位置环的指挥,下面给电流环下命令。
我刚开始做伺服驱动时,总觉得速度环是最容易搞定的。后来才发现,恰恰是这个中环,最容易出幺蛾子。电流环调不好,顶多是电机嗡嗡响;速度环调不好,整个系统可能直接飞车。
速度环到底在干什么?
速度环的核心任务就一个:让电机的实际转速,死死咬住你给的目标转速。
你想想看,位置环说「我要转10圈」,那速度环就得算出来「每秒转多少转才能刚好在指定时间到达」。然后它把这个转速指令发给电流环,电流环再去控制电机出力。
这里有个关键点:速度环的输出,就是电流环的输入。也就是说,速度环算出来的结果,直接决定了电机要出多大的力。
速度环的输入:目标转速(来自位置环或直接给定)
速度环的输出:电流指令(送给电流环)
速度环的反馈:实际转速(来自编码器测量)
速度怎么测?三种方法各有千秋
测速度,说白了就是「看单位时间内转了多少」。但具体怎么算,这里头有讲究。我做过不少项目,踩过坑,也总结了一些经验。
1. M法(测频法)
M法的思路很简单:固定一段时间,数一数编码器发出了多少个脉冲。
转速 = (脉冲数 / 编码器线数) / 测量时间 * 60
举个例子:编码器是1000线,测量时间是10ms,数到了50个脉冲。
转速 = (50 / 1000) / 0.01 * 60 = 300 RPM
优点:高速时精度高,因为脉冲多,数得准。
缺点:低速时脉冲少,误差大。你想想,如果电机只转1RPM,10ms内可能一个脉冲都数不到。
我的经验:M法适合300RPM以上的场合。低于这个值,我建议换方法。
2. T法(测周法)
T法反过来:测量两个脉冲之间的时间间隔。
转速 = 1 / (时间间隔 * 编码器线数) * 60
比如两个脉冲间隔了1ms,编码器1000线:
转速 = 1 / (0.001 * 1000) * 60 = 60 RPM
优点:低速时精度高,因为脉冲间隔长,测得准。
缺点:高速时脉冲间隔太短,计时器分辨率不够,误差反而大。
注意:T法在高速时,时间间隔可能只有几微秒。如果你的计时器分辨率不够,测出来的转速会跳得厉害。
3. M/T法(混合法)
M法和T法各有短板,那能不能结合起来?当然可以。M/T法就是同时测量脉冲数和时间,然后取一个综合值。
转速 = (脉冲数 / 编码器线数) / 测量时间 * 60
但这里的「测量时间」不是固定的,而是等到整数个脉冲到达时才结束。这样既保证了脉冲数够多,又保证了时间测量准确。
优点:全速域精度都不错。
缺点:实现稍微复杂一点,需要硬件支持。
| 方法 | 适用场景 | 精度特点 | 实现难度 |
|---|---|---|---|
| M法 | 高速(>300RPM) | 高速精度高 | 简单 |
| T法 | 低速(<300RPM) | 低速精度高 | 简单 |
| M/T法 | 全速域 | 综合精度好 | 中等 |
速度环的PI控制器设计
速度环的控制器,99%的情况下用PI就够了。为什么不用PID?因为微分项(D)对噪声太敏感,速度环的反馈信号本身就有波动,再加D项,系统容易抖。
PI控制器的公式:
输出 = Kp * 误差 + Ki * 积分(误差)
其中:
- Kp(比例系数):决定响应速度。Kp越大,响应越快,但太大容易超调。
- Ki(积分系数):消除稳态误差。Ki越大,消除误差越快,但太大容易振荡。
我个人的习惯是:先调Kp,再调Ki。具体步骤:
- 先把Ki设成0,只调Kp。慢慢增大Kp,直到系统开始出现轻微振荡。
- 然后把Kp往回退一点(比如退到振荡值的70%)。
- 再慢慢增加Ki,直到稳态误差消失。
避坑指南:我曾经在一个项目中,Ki调得太大,结果电机在低速时一抖一抖的,像打嗝一样。后来才发现,积分项累积太快,导致输出饱和了。解决办法是加了积分限幅。
速度环与电流环的级联关系
速度环和电流环是串在一起的,就像俄罗斯套娃。电流环在最里面,速度环包着它。
这里有个重要的设计原则:内环(电流环)的带宽,要比外环(速度环)快5-10倍。
为什么?因为速度环要依赖电流环的执行结果。如果电流环反应慢,速度环算出来的指令半天执行不了,那整个系统就会失控。
我举个例子你就明白了:
- 电流环的响应时间:1ms
- 速度环的响应时间:5-10ms
这样,速度环每发一个指令,电流环都能在下一个速度环周期到来之前完成。系统才能稳定。
注意:如果电流环带宽不够,速度环调得再好也没用。就像你让一个跑得慢的人去接快球,怎么接都接不住。
知识体系总览
下面这张图,是我自己整理的。它把速度环的核心知识点串在了一起,方便你理解整体结构。
小结
速度环这个东西,说难不难,说简单也不简单。关键就三点:
- 测速要准:根据转速范围选对方法,M法、T法还是M/T法,心里要有数。
- PI要稳:先Kp后Ki,加积分限幅,别让积分饱和坑了你。
- 级联要对:电流环带宽必须比速度环快,这是铁律。
嗯,这一章就讲到这里。下一章我们聊聊位置环——那个站在最外层的「总指挥」。