041、FOC速度环与位置环设计
一、从一次电机“鬼畜”抖动说起
去年调试一个六轴协作机器人，第三关节在低速运行时出现周期性抖动，示波器抓电流波形发现q轴电流在目标值附近来回震荡，频率大约8Hz。当时第一反应是速度环PI参数没调好，但反复调整Kp和Ki后抖动依然存在，甚至把积分限幅从额定电流的80%降到20%也无济于事。
后来用上位机同时记录速度环输出和位置环输出，发现位置环的输出在速度环的输入端叠加了一个低频扰动——位置环的积分项在零点附近反复穿越，导致速度环的给定值一直在正负之间跳变。这个案例让我意识到，速度环和位置环的耦合设计远比单独调参复杂得多。
二、速度环设计的三个“坑”
坑1：采样率与带宽的匹配
很多初学者把速度环的采样率设得越高越好，结果反而引入高频噪声。FOC中速度环的采样率通常取电流环的1/10到1/5，比如电流环20kHz，速度环2kHz~4kHz。为什么？因为速度环的带宽受限于机械系统的惯性，你不可能让电机在1ms内从0转到1000rpm。
实际调试时，我习惯先用手册上的电机机械时间常数τm（通常几十毫秒到几百毫秒），把速度环带宽设为1/(2πτm)的35倍。比如τm=50ms，带宽约3.2Hz，速度环带宽取1016Hz，对应采样率至少160Hz以上。但别直接套公式，电机带负载后τm会变，得实测。
坑2：积分饱和的“隐形杀手”
速度环的积分项在电机堵转或限速时会疯狂累积，一旦解除限制，积分项释放会
