第四节：速度环整定——速度环带宽概念、速度环增益与积分时间常数、速度前馈补偿
各位工程师朋友，咱们今天聊聊速度环整定。说实话，速度环是整个运动控制里最「磨人」的一环。位置环调不好，顶多定位慢一点；速度环调不好，机器直接抖给你看。我当年刚入行时，就被一台晶圆搬运台的「低频振荡」折磨了整整三天……嗯，今天就把这些经验掰开揉碎讲清楚。
一、速度环带宽：到底在说什么？
速度环带宽，说白了就是驱动器能「响应多快」的频率范围。你给电机一个正弦波速度指令，频率从低往高扫，当实际速度的幅值掉到指令的70.7%（也就是-3dB）时，对应的频率就是带宽。
举个例子：带宽100Hz，意味着电机能跟上100Hz以内的速度变化。超过这个频率，电机就「力不从心」了。
核心结论：带宽越高，系统响应越快，但噪声也越容易被放大。我见过有人把带宽调到300Hz，结果电机像「跳舞」一样高频尖叫——这就是过犹不及。
带宽受什么限制？三个因素：
- 机械谐振频率：带宽不能超过机械谐振频率的1/3到1/2。否则，你调的不是速度环，是「共振放大器」。
- 电流环响应：速度环带宽通常只有电流环的1/5到1/10。电流环是「小弟」，速度环是「大哥」，大哥不能比小弟跑得快。
- 采样周期：速度环采样周期决定了理论极限带宽。比如1kHz采样，理论极限是500Hz，实际能到200Hz就不错了。
我的经验：对于半导体设备，晶圆传输机械手的速度环带宽通常设在30-80Hz。太高了，晶圆容易「飞出去」；太低了，加减速时跟丢位置。
二、速度环增益与积分时间常数：一对「欢喜冤家」
速度环的核心参数就两个：速度环增益（Kv）和积分时间常数（Ti）。它们的关系，就像油门和刹车——配合好了，又快又稳；配合不好，要么冲出去，要么原地抖。
2.1 速度环增益（Kv）
Kv决定了系统对速度误差的「反应力度」。Kv越大，电机对速度偏差的纠正越猛，响应越快。但Kv过大，系统会振荡——就像你开车猛打方向盘，车会甩尾。
我习惯这样调：
- 先把积分时间常数设到最大（相当于关掉积分），只调Kv。
- 从一个小值开始，比如10，慢慢往上加。
- 当电机开始出现「嗡嗡」声或轻微抖动时，记下这个值。
- 把Kv降到这个值的60%-70%，作为最终值。
注意：Kv的单位通常是「A/(rad/s)」或「Nm/(rad/s)」。不同驱动器厂家叫法不同，有的叫「速度环比例增益」，有的叫「速度环增益」。别搞混了。
2.2 积分时间常数（Ti）
积分的作用是消除稳态误差。说白了，如果电机因为摩擦力或负载变化，速度总是差那么一点点，积分就会「慢慢累积」把误差吃掉。
Ti越小，积分作用越强，消除误差越快。但Ti太小，系统会「过冲」——速度超调后振荡好几下才稳定下来。
我常用的经验公式：
Ti ≈ 1 / (2 * π * 带宽 * 0.3)
比如带宽80Hz：
Ti ≈ 1 / (2 * 3.14 * 80 * 0.3) ≈ 0.0066秒 ≈ 6.6ms当然，这只是起点。实际调试时，我会用示波器看速度阶跃响应：
- 如果超调量超过10%，说明Ti太小了，适当增大。
- 如果稳态误差一直消不掉，说明Ti太大了，适当减小。
避坑指南：我曾经遇到一台设备，速度环怎么调都有低频振荡。查了半天，发现是积分时间常数设成了0.1ms——太小了，积分饱和导致系统「抽风」。后来改成5ms，问题解决。嗯，有时候问题不在增益，在积分。
三、速度前馈补偿：让系统「预判」你的指令
速度前馈，说白了就是「提前给油」。你想想看，如果只靠反馈控制，电机总是「看到误差才动」，永远慢半拍。前馈的作用是：根据指令的变化趋势，提前给一个补偿量，让电机「同步」跟上。
速度前馈通常有两种：
- 加速度前馈：根据速度指令的微分（加速度），提前补偿惯性力。
- 速度前馈：直接根据速度指令，补偿摩擦力等与速度相关的扰动。
在半导体设备中，我最常用的是加速度前馈。因为晶圆传输时，加减速阶段的惯性力是最大的扰动源。
3.1 前馈系数怎么调？
我一般分三步走：
- 先关掉前馈（系数设为0），调好速度环的Kv和Ti。
- 从0开始慢慢增加前馈系数，观察速度跟踪误差。
- 当前馈系数让跟踪误差减小到原来的1/3以下时，基本就到位了。
关键点：前馈系数不是越大越好。过大的前馈会导致「过补偿」——电机在加减速时反而出现反向误差。我见过有人把前馈系数设到120%，结果加速时速度超调，减速时速度滞后，比没加前馈还差。
3.2 一个实际案例
去年调试一台晶圆分选机，速度环带宽设在60Hz，Kv=45，Ti=8ms。不加前馈时，加减速阶段的速度跟踪误差有±5rpm。加上30%的加速度前馈后，误差降到±1rpm以内。效果立竿见影。
但要注意：前馈依赖模型精度。如果负载惯量变化大（比如机械手抓取不同重量的晶圆），前馈效果会打折扣。这时候，我建议用自适应前馈或扰动观测器来补偿——不过那是更高级的话题了。
四、知识体系总览
下面这张图，是我自己总结的速度环整定核心逻辑。你可以把它当作调试时的「路线图」：
五、总结一下
速度环整定，说白了就是三个字：快、准、稳。
- 带宽决定了你能「快」到什么程度——但别贪心，要给机械留余量。
- Kv和Ti决定了你能不能「准」——Kv给力，Ti收尾，配合好了误差自然小。
- 前馈决定了你能不能「稳」——提前补偿，让系统少折腾。
我个人习惯是：先用手动模式让电机跑一个梯形速度曲线，看跟踪误差。如果误差波形像「正弦波」，说明Kv不够；如果误差波形像「尖峰」，说明前馈不够。嗯，多试几次，手感就出来了。
最后提醒一句：别迷信参数。再好的参数也救不了烂的机械设计。如果电机抖得厉害，先检查联轴器有没有松动、导轨有没有磨损——我吃过这个亏，白白浪费了两天调参数。
公众号:蓝海资料掘金营，微信deep3321