伺服控制基础：从PID到三环，再到前馈与陷波

大家好，我是你们这堂课的主讲人。在光刻机运动台这个领域摸爬滚打了十几年，我最大的感触就是：伺服控制是运动台的灵魂。今天咱们聊的这几个概念——PID、三环、前馈、陷波——听起来像是教科书上的老古董，但说实话，我每次调试新机器，都还得跟它们打交道。

嗯，咱们不搞那些虚的。直接上干货。

PID控制原理：最朴素的智慧

PID，比例-积分-微分。说白了，就是三个字：现在、过去、未来。

• 比例（P）：看现在。误差有多大，我就给多大的力。你偏了1毫米，我推你1牛顿；你偏了2毫米，我推你2牛顿。简单粗暴。
• 积分（I）：看过去。误差一直存在？那我慢慢累积力量，直到把它消除。比如你一直有0.1毫米的静差，积分项就会慢慢加力，直到你归零。
• 微分（D）：看未来。误差变化快了？我提前刹车或加速。比如你正快速冲向目标，微分项会提前减小输出，防止你冲过头。

我在项目中遇到过一件事：有一次调试一个高速晶圆台，P给大了，台子抖得像筛糠；P给小了，又慢得像蜗牛。后来加了点D，瞬间稳了。你想想看，这就是微分的魅力——它像是一个“预见者”。

u(t) = Kp * e(t) + Ki * ∫e(t)dt + Kd * de(t)/dt

三环控制结构：位置环、速度环、电流环

光刻机运动台的控制，不是单打独斗。它是个三层架构，像俄罗斯套娃一样，一环套一环。

咱们从内到外说：

1. 电流环（最内层）：控制电机电流，也就是力矩。响应最快，周期通常在几十微秒。说白了，就是让电机“听话”，要多少力给多少力。
2. 速度环（中间层）：控制电机转速。它给电流环发指令：“我需要这个速度，你给相应的力。”响应周期在几百微秒到几毫秒。
3. 位置环（最外层）：控制最终位置。它给速度环发指令：“我需要这个位置，你以这个速度跑过去。”响应周期在几毫秒到十几毫秒。

为什么会这样设计？你想想看，如果直接让位置环去控制电流，那中间隔着速度变化，很容易振荡。分层控制，每一层只关心自己的事，稳定多了。

我曾经调试过一个项目，位置环带宽怎么也上不去。后来发现是速度环的响应太慢，拖了后腿。嗯，这里要注意：三环的带宽必须逐层拉开，一般差3-5倍。电流环最快，速度环次之，位置环最慢。

前馈控制原理：让系统跑得更聪明

反馈控制是“出了错再纠正”，前馈控制是“提前知道要出错，提前补偿”。

举个例子：你要让运动台以恒定加速度运动。反馈控制会在速度偏差出现后才去调整，总有点滞后。而前馈控制，直接根据加速度指令，提前给一个对应的力矩。这样，系统几乎无延迟地跟随指令。

前馈的典型形式包括：

• 速度前馈：根据目标速度，提前给一个对应的电压/电流。
• 加速度前馈：根据目标加速度，提前给一个对应的力。
• 摩擦前馈：根据运动方向，提前补偿摩擦力。

u_ff = K_aff * a_target

我个人习惯是：先调好反馈环，再加前馈。前馈加得好，跟踪误差能降低一个数量级。但加得不好，反而会引入噪声。

陷波滤波器原理：专治机械共振

光刻机运动台，说白了就是一堆金属和电机。机械结构总有共振频率。一旦控制器的输出频率接近共振点，台子就会剧烈抖动，甚至失控。

陷波滤波器，就是专门用来“掐掉”这个共振频率的。它像一个带阻滤波器，只衰减特定频率的信号，其他频率不受影响。

它的传递函数长这样：

G(s) = (s² + ωz²) / (s² + ωp * s + ωp²)

其中 ωz 是零点频率，ωp 是极点频率。通过调整这两个参数，可以精确地“挖掉”共振峰。

我在项目中遇到过一台机器，在150Hz附近有个明显的共振峰。加了陷波滤波器后，振幅直接降了20dB。嗯，这里要注意：陷波滤波器不能加太多，否则会引入相位滞后，影响系统稳定性。

知识体系总览

说了这么多，咱们用一张图来总结一下本章的核心逻辑。这张图是我自己画的，把PID、三环、前馈、陷波的关系串在了一起。

这张图你看懂了吗？PID是基础算法，它嵌入在三环的每一环中。前馈是“开挂”，叠加在反馈之上，让系统跑得更快更准。陷波滤波器是“清道夫”，串联在控制通路中，专门干掉机械共振。

好了，这一章的内容就到这里。记住：理论是死的，但应用是活的。下次你调试伺服系统时，不妨想想我今天说的这些“坑”和“窍门”。