第1章:位置环基础
大家好,我是你们的老朋友。今天咱们聊聊位置环——这个伺服系统里最基础、也最容易被忽视的环节。
说实话,我刚开始做运动控制那会儿,总觉得位置环不就是个PID嘛,调调参数就完事了。直到有一次,一台六轴机器人做圆弧插补时,末端抖得跟筛糠似的……查了三天,最后发现是位置环采样周期没选对。嗯,从那以后,我再也不敢小看这个“基础”了。
1.1 位置环在伺服系统中的作用
伺服系统一般分三层:电流环、速度环、位置环。位置环在最外层,说白了就是“指挥者”。它告诉电机:你要转到哪个角度,或者走到哪个位置。
具体来说,位置环干三件事:
- 接收指令:从上位机或运动控制器拿到目标位置
- 比较反馈:跟编码器读回来的实际位置做差
- 输出修正:算出速度指令,交给速度环去执行
我个人的习惯是,把位置环想象成一个“纠错员”。它不关心电机怎么转得快,只关心“你到没到地方”。没到?那就继续发指令,直到误差为零。
1.2 位置环的数学模型
搞控制,绕不开数学。但别怕,咱们用最直观的方式讲。
位置环的输入是位置误差 e(t),输出是速度指令 v(t)。最简单的模型就是比例控制:
v(t) = Kp × e(t)
其中:
- e(t) = θ_ref(t) - θ_fb(t) —— 目标位置减实际位置
- Kp —— 位置环比例增益
但实际系统哪有这么理想?电机有惯性,负载有摩擦,编码器有量化误差。所以完整的数学模型得考虑这些:
v(t) = Kp × e(t) + Ki × ∫e(t)dt + Kd × de(t)/dt
这就是位置环的PID形式。我在项目中遇到过一种情况:只用P控制时,设备停稳后总有0.1mm的静差。加了I项之后,静差才消除。说白了,I项就是用来“磨”掉那些顽固误差的。
不过要注意,位置环的数学模型跟速度环、电流环是串联的。位置环输出的是速度指令,速度环再输出电流指令。所以位置环的带宽,一定要低于速度环的带宽——这是铁律。
1.3 位置环的PID控制原理
PID三个字母,每个都有自己的脾气。
| 参数 | 作用 | 调大后的效果 | 调小后的效果 |
|---|---|---|---|
| Kp(比例) | 快速响应误差 | 响应快,但容易超调 | 响应慢,稳态误差大 |
| Ki(积分) | 消除稳态误差 | 消除静差,但可能震荡 | 静差消除慢 |
| Kd(微分) | 抑制超调,预测趋势 | 系统更稳定,但噪声敏感 | 超调变大 |
我曾经调试一台贴片机,位置环Kp调得很大,响应是快了,但每次到位后都要来回震荡两三下才停稳。后来加了点微分项,震荡立马压下去了。嗯,这就是Kd的妙用——它相当于一个“刹车”,提前预判你要超调,先给你拉住。
但Kd不能乱加。我记得有一次在振动比较大的机台上,微分项把编码器的噪声放大了,结果电机反而抖得更厉害。所以,如果编码器分辨率不高或者现场干扰大,我建议Kd设小一点,甚至不用。
1.4 位置环的采样周期选择
采样周期,说白了就是“多久算一次位置误差”。这个参数选不好,前面调得再好也白搭。
采样周期太短:CPU忙不过来,还可能引入高频噪声。
采样周期太长:位置更新慢,轨迹跟踪会滞后。
那怎么选?我一般遵循两个原则:
- 采样周期要小于位置环时间常数的1/10。比如位置环带宽20Hz,对应时间常数约50ms,那采样周期最好小于5ms。
- 采样周期要跟编码器分辨率匹配。分辨率越高,采样周期可以越短。反之,如果编码器每转只有1000线,采样周期1ms和10ms差别不大。
实际项目中,我常用的位置环采样周期是:
- 通用伺服:1ms - 4ms
- 高速贴片机:0.5ms - 1ms
- 大型龙门铣:4ms - 10ms
你想想看,如果采样周期是4ms,那位置环每4ms才更新一次指令。对于高速运动来说,这4ms里电机可能已经跑偏了不少。所以,高速场合一定要用短采样周期。
知识体系总览
下面这张图,是我自己画的位置环知识结构。你可以把它当成一张“地图”,学完本章后对照着回顾一下。
这张图把位置环的四个核心知识点串起来了。你从中心往外看,每个分支都是一个独立的知识模块,但它们又相互关联——比如采样周期会影响PID的调节效果,数学模型又是PID的理论基础。
好了,位置环的基础就聊到这儿。记住一句话:位置环是伺服系统的“大脑”,调好了它,后面的速度环和电流环才能发挥出真正的性能。