第3章精密运动控制基础

3. 精密运动控制基础：运动控制基本概念、PID控制原理、前馈控制、轨迹规划基础

各位好，我是老张。在光刻机双工件台这个领域摸爬滚打了十几年，今天咱们来聊聊精密运动控制的基础。说实话，这部分内容看着基础，但恰恰是决定一台光刻机能不能干活的命门。你想想看，工件台在高速运动下要跑到纳米级的定位精度，没有扎实的控制理论打底，根本不可能。

先说说运动控制到底是个啥。说白了，就是让电机带着负载，按照我们想要的轨迹跑起来，并且停得准、跑得稳。在双工件台系统里，我们面对的是六个自由度的运动控制——X、Y、Z三个直线轴，加上Rx、Ry、Rz三个旋转轴。

我个人习惯把运动控制拆成三个层次来看：

这里有个坑，我刚开始做项目时踩过。很多人觉得只要伺服控制器够好，运动控制就稳了。其实不然。你想想看，轨迹规划得不好，伺服再牛也救不回来。就像开车，路都规划歪了，方向盘打得再快也白搭。

核心指标：在双工件台里，我们最关心三个指标——定位精度（能不能停到目标位置）、重复定位精度（每次停的位置是否一致）、运动平稳性（加减速过程有没有抖动）。这三个指标互相制约，你得学会取舍。

PID控制，搞运动控制的人没有不知道的。比例、积分、微分，三个参数调得好，系统稳如老狗；调不好，那就是灾难现场。

我给大家画个简单的框图，看看PID在双工件台里是怎么工作的：

这张图看着简单，但每个环节都有讲究。我一个个说：

比例项就是当前误差乘以一个系数。误差大，输出就大。但有个问题——纯比例控制会有稳态误差。我记得有一次调试一个直线电机平台，P增益调到很大，结果系统开始震荡，嗡嗡响。后来才明白，P太大不是好事。

积分项负责消除稳态误差。它把过去的误差累积起来，慢慢修正。但积分有个副作用——容易引起超调。我建议在双工件台的粗动台（长行程）上用积分，精动台（短行程）上尽量少用甚至不用。

微分项看的是误差的变化趋势。它能提前预判，抑制超调。但微分对噪声特别敏感。光栅尺的信号稍微有点毛刺，微分项就会放大，导致电机乱抖。嗯，这里要注意，实际项目中我一般会在微分通道上加个低通滤波器。

我的经验：调PID有个口诀——先P后I再加D。先把P调到系统刚好不震荡，然后加I消除静差，最后加D抑制超调。别一上来三个参数一起调，那是在碰运气。

光靠PID，在双工件台这种高速高精度的场合是不够的。为什么？因为PID是事后诸葛亮——它看到误差了才去纠正。但前馈控制不一样，它提前知道要干什么，直接给一个补偿量。

我给大家看个公式就明白了：

总控制量 = PID输出 + 前馈输出

前馈输出 = 质量 × 加速度 + 阻尼 × 速度 + 摩擦力补偿

说白了，前馈就是根据模型预测出电机需要多少力，提前给上去。这样PID只需要处理模型误差和扰动，压力小很多。

我曾经在一个项目中，只用PID时，跟踪误差有50微米。加了前馈后，直接降到2微米以内。你想想看，这个提升有多大。

注意：前馈控制依赖模型精度。模型不准，前馈反而会帮倒忙。我建议先用系统辨识的方法把电机参数测准了，再设计前馈控制器。别偷懒，这一步省不了。

轨迹规划，就是决定电机怎么从A点跑到B点。在双工件台里，我们常用的轨迹有几种：

S曲线是我用得最多的。它把加速度的变化率（加加速度）也约束住了，这样电机不会产生冲击力。你想想看，工件台上放着12寸的硅片，一个冲击可能就导致硅片移位，那损失可就大了。

轨迹规划还有个关键参数——速度前馈和加速度前馈。这两个参数要和前馈控制器配合好。我一般会在轨迹生成时就计算出速度和加速度的实时值，直接送给前馈控制器，这样延迟最小。

避坑指南：我曾经遇到过一个问题——轨迹规划得挺好，但实际跑起来就是抖。查了半天，发现是轨迹的采样周期和伺服控制器的周期没对齐。轨迹每1ms更新一次，但伺服是125μs一个周期，中间差了8倍。后来我把轨迹做了插值，问题就解决了。所以，时序对齐是轨迹规划里最容易忽略但又最重要的一环。

好了，精密运动控制的基础就聊到这儿。这些概念看着简单，但真正用好，需要大量的实践积累。我建议大家有空多动手调调参数，纸上谈兵是学不会的。

公众号:蓝海资料掘金营，微信deep3321