2. 跟随控制基础:位置环、速度环、电流环三环架构解析、跟随误差的概念、跟随精度的指标
做电子齿轮跟随,说白了就是让从轴老老实实跟着主轴跑。但怎么才能跟得紧、跟得稳?这就要聊到伺服驱动的三环架构了。我刚开始接触这个的时候,也觉得三个环叠在一起挺唬人的,其实拆开来看,每个环都有自己的脾气。
2.1 三环架构:从里到外三层皮
伺服驱动器的控制,典型的就是三个闭环串在一起。从最里面的电流环,到中间的速环,再到最外面的位置环。你想想看,这就像三层嵌套的护卫队——最里面管力气,中间管速度,外面管位置。
核心逻辑:电流环最快,速度环次之,位置环最慢。响应速度依次递减,但控制精度依次递增。
2.1.1 电流环(最内层)
电流环是三个环里响应最快的。它的任务很简单——让电机实际电流死死咬住你给的电流指令。我见过不少工程师调不好电流环,结果电机嗡嗡响,发热严重。说白了,电流环带宽不够,电机就像得了哮喘。
- 控制对象:电机绕组电流(Id/Iq)
- 典型带宽:1kHz ~ 3kHz(看驱动器性能)
- 常用算法:PI控制,有时候加前馈
- 采样周期:一般在50μs ~ 100μs
我的经验:调电流环时,先把积分系数置零,只调比例。让电流响应不振荡、不超调,然后再慢慢加积分。我曾经在一个项目中,电流环比例给太大,结果电机像发了疯一样抖,差点把联轴器抖断了。
2.1.2 速度环(中间层)
速度环坐在电流环外面。它给电流环发指令——「我需要这么大的扭矩,你去实现」。速度环的带宽一般比电流环低一个数量级。为什么?因为速度反馈通常来自编码器,有延迟,带宽上不去。
- 控制对象:电机转速
- 典型带宽:100Hz ~ 500Hz
- 常用算法:PI + 速度前馈
- 采样周期:一般在200μs ~ 1ms
嗯,这里要注意。速度环的PI参数和电流环是联动的。你电流环没调好,速度环再怎么调也是白搭。我习惯先把电流环带宽拉到最高,再回头调速度环。
2.1.3 位置环(最外层)
位置环是老大,它决定最终的位置精度。位置环的输出就是速度环的指令。位置环的带宽最窄,一般也就几十赫兹。你想想看,位置环要处理编码器的位置反馈,还要算跟随误差,响应快不了。
- 控制对象:电机轴位置/负载位置
- 典型带宽:10Hz ~ 50Hz
- 常用算法:P控制(很少用I,容易积分饱和)
- 采样周期:一般在1ms ~ 4ms
避坑指南:我曾经在一个电子齿轮项目中,位置环比例增益给太大,结果从轴在启动瞬间猛冲了一下,直接把工件撞废了。位置环的P增益一定要从零慢慢往上加,别心急。
2.2 三环架构的SVG结构图
2.3 跟随误差:到底差了多少?
跟随误差,英文叫 Following Error。说白了就是主轴位置和从轴位置的差值。你给主轴发一个位置指令,从轴拼命追,但永远追不上——这个差值就是跟随误差。
为什么会这样?因为从轴有惯性,有摩擦,有响应延迟。你想想看,主轴跑得越快,从轴追得越吃力,跟随误差就越大。我在一个包装机械项目中,主轴转速从1000rpm提到3000rpm,跟随误差直接翻了三倍。
跟随误差公式:
E_follow = P_master - P_slave
其中:
- E_follow:跟随误差(单位:脉冲数或角度)
- P_master:主轴实际位置
- P_slave:从轴实际位置
2.4 跟随精度的指标:怎么才算「跟得好」?
做电子齿轮,不能光说「跟得还行」,得有量化指标。我一般用以下几个指标来评判:
| 指标名称 | 定义 | 典型要求 | 我的经验值 |
|---|---|---|---|
| 最大跟随误差 | 整个运动过程中,跟随误差的最大绝对值 | < 10个脉冲 | 一般控制在5个脉冲以内比较稳 |
| 平均跟随误差 | 稳态运行时,跟随误差的平均值 | < 2个脉冲 | 能做到1个脉冲以内才算优秀 |
| 跟随误差标准差 | 反映跟随误差的波动程度 | < 3个脉冲 | 越小越好,波动大说明有振荡 |
| 稳态误差 | 匀速段跟随误差的稳定值 | 趋近于0 | 理论上PI控制可以做到0 |
我的习惯:调试时我一般先看最大跟随误差。如果这个值超了,说明系统响应跟不上。然后看标准差,如果标准差大,说明有振荡或者噪声干扰。最后才看平均值——平均值好调,但动态性能难搞。
2.5 影响跟随精度的关键因素
做项目多了你会发现,影响跟随精度的因素就那么几个:
- 三环带宽匹配:电流环带宽 > 速度环带宽 > 位置环带宽。这个顺序不能乱。我曾经见过有人把速度环带宽调得比电流环还高,结果系统直接啸叫。
- 编码器分辨率:分辨率越高,位置反馈越精细,跟随误差理论上可以更小。但分辨率太高也会引入噪声。
- 机械传动间隙:齿轮间隙、联轴器弹性变形,这些都会在跟随误差上表现出来。我有个项目,换了高刚性联轴器,跟随误差直接降了一半。
- 加减速时间:加减速越陡,跟随误差越大。所以电子齿轮的加速度要合理设置,别太激进。
避坑指南:我曾经在一个项目中,为了追求极致的跟随精度,把位置环比例增益拉到很高。结果从轴在启动时剧烈振荡,编码器反馈的脉冲数像过山车一样。后来我才明白——位置环的增益不是越高越好,要兼顾稳定性和响应速度。
2.6 小结
三环架构是电子齿轮跟随控制的地基。电流环管力气,速度环管快慢,位置环管位置。三个环各司其职,又互相影响。跟随误差是衡量「跟得好不好」的直接指标,而跟随精度则是一组量化指标的综合体现。
嗯,这一章的内容就到这里。记住一句话:三环调好了,电子齿轮就成功了一半。