3. 运动控制基础

半导体设备中的龙门双驱系统（如光刻机工件台、晶圆传输机械臂、精密划片机）对定位精度、同步误差和动态响应有着严苛要求。理解运动控制的三环架构——电流环、速度环、位置环——是进行设备调试、振动抑制和性能优化的根基。三环控制并非简单的三层PID堆叠，而是基于物理对象（电机-机械负载）特性、带宽匹配原则和抗扰需求设计的级联控制结构。本章将深入剖析三环各自的作用边界、PID参数整定的工程方法，以及前馈控制在提升轨迹跟踪精度中的关键价值。

上图展示了龙门双驱系统中三环级联控制的基本信号流。位置环根据指令位置与实际位置的偏差生成速度指令；速度环跟踪该指令并输出电流（转矩）指令；电流环则控制电机绕组电流快速跟踪给定值。前馈信号（速度前馈、加速度前馈）从位置指令侧直接提取微分信息，叠加到速度环或电流环的输入端，以补偿反馈控制的相位滞后。在龙门双驱架构中，两个直线电机（X1轴、X2轴）各自拥有独立的三环控制，同时通过同步误差补偿器进行交叉耦合校正。

3.1 三环控制的核心原理与带宽匹配

3.1.1 电流环：转矩产生的第一道关口

电流环是控制链路中最内层、带宽最高的环节。对于永磁同步直线电机（PMLSM），电磁推力与q轴电流成正比（F = Kt × Iq）。电流环的作用是让实际电流快速、准确地跟踪指令电流，从而精确控制电磁推力。电流环通常采用PI控制器，其输出为PWM占空比信号，驱动逆变器功率管。由于电气时间常数远小于机械时间常数，电流环的响应速度远快于速度环和位置环。

电流环的带宽一般设计为1~5 kHz，具体取决于逆变器开关频率（通常10~20 kHz）、电流采样延迟和电机电感。在龙门双驱中，两个电机的电流环完全独立，但需要保证电流采样同步，避免因采样时刻不一致导致推力波动。

3.1.2 速度环：抑制扰动与负载变化的核心

速度环位于电流环外层，其输入为位置环输出的速度指令，反馈为电机实际速度（通过编码器差分或状态观测器获得）。速度环采用PI控制器，输出为电流指令。速度环的主要功能包括：

• 抑制负载扰动：当龙门横梁上的工艺负载（如真空吸盘吸附晶圆）发生变化时，速度环能快速调整电流指令以维持速度恒定。
• 克服摩擦与纹波推力：直线电机的齿槽力、端部效应和电缆拖链阻力会引入周期性扰动，速度环的积分作用可有效消除稳态速度误差。
• 提供阻尼：速度环的比例增益相当于在机械系统中引入虚拟阻尼，抑制机械谐振。

速度环带宽通常为100~500 Hz，约为电流环带宽的1/10~1/5。速度环的反馈质量至关重要，编码器分辨率不足或采样延迟过大会限制速度环带宽。

3.1.3 位置环：最终定位精度的保障

位置环是三环中最外层的控制环节，输入为轨迹规划器生成的位置指令，反馈为光栅尺或高分辨率编码器测量的实际位置。位置环通常采用纯比例（P）控制器，输出为速度指令。位置环带宽一般为5~30 Hz，远低于速度环和电流环。

位置环的增益（Kp_p）决定了系统的定位刚度和跟踪误差。增大Kp_p可减小稳态跟踪误差，但过大会导致系统超调甚至不稳定。在龙门双驱中，位置环还承担着同步误差控制的任务——两个轴的位置环需要协同工作，确保横梁不发生扭转。

3.2 PID参数整定基础与工程方法

3.2.1 从内到外的整定顺序

三环PID参数整定必须遵循先内后外的原则：先整定电流环，再整定速度环，最后整定位置环。这是因为外环的性能依赖于内环的闭环传递函数，内环未整定好时，外环的调试毫无意义。

1. 电流环整定：断开速度环和位置环，给电流环施加阶跃指令，观察电流响应。调节Kp_i和Ki_i，使电流阶跃响应无超调或微超调（<5%），上升时间尽量短（通常<1 ms）。
2. 速度环整定：闭合电流环，断开位置环，给速度环施加阶跃或斜坡指令。先调Kp_v（比例增益），增大直到速度出现轻微振荡，然后回调至60%~70%；再调Ki_v（积分增益），消除稳态速度误差。
3. 位置环整定：闭合速度环和电流环，给位置环施加阶跃或S曲线指令。调节Kp_p，观察定位响应。位置环通常不加积分（避免超调），若存在稳态误差可考虑前馈补偿。

3.2.2 频域整定法（工程实用）

除了时域阶跃响应法，频域法在半导体设备调试中更为常用。通过扫频仪或伺服分析仪测量各环的开环Bode图，调整增益使穿越频率（0 dB点）落在目标带宽附近，并保证足够的相位裕度（>45°）和幅值裕度（>6 dB）。

// 以速度环为例的频域整定流程
1. 闭合电流环，断开位置环
2. 注入扫频信号（1 Hz ~ 2 kHz），测量速度环开环频率响应
3. 观察穿越频率fc：若fc过低，增大Kp_v；若fc处相位滞后过大，减小Ki_v
4. 目标：fc ≈ 目标速度带宽（如200 Hz），相位裕度 ≥ 45°
5. 若存在机械谐振峰，需添加陷波滤波器（Notch Filter）后再整定

3.2.3 龙门双驱的同步参数整定

在龙门双驱中，除了各轴独立的三环参数外，还需要整定同步误差补偿器的参数。常见的同步控制策略包括主从控制（Master-Slave）和交叉耦合控制（Cross-Coupling）。交叉耦合控制将两轴的位置误差之差（即同步误差）作为附加反馈，分别补偿到两个轴的电流指令中。

3.3 前馈控制：速度前馈与加速度前馈

3.3.1 为什么需要前馈？

反馈控制本质上是一种“事后纠偏”——只有偏差出现后才能产生修正动作。对于半导体设备中的高速高精度轨迹跟踪（如光刻机工件台的步进扫描运动），纯反馈控制会导致显著的跟踪滞后。例如，当位置指令以1 m/s²加速度运动时，位置环的跟踪误差约为 Vmax / (2π × BW_pos)，其中BW_pos为位置环带宽。若BW_pos=10 Hz，则跟踪误差可达16 mm——这在纳米级定位中是不可接受的。

前馈控制的基本思想是：根据指令信号的微分信息，提前计算出所需的控制量，直接叠加到反馈输出上，从而消除反馈控制的相位滞后。

3.3.2 速度前馈与加速度前馈的数学表达

在龙门双驱系统中，前馈信号通常注入到电流指令端（即速度环的输出端）。设位置指令为 x_cmd(t)，则：

• 速度前馈：F_vff = Kvff × dx_cmd/dt。速度前馈相当于在速度环中提前加入速度指令的微分补偿，可消除速度环的跟踪滞后。Kvff的理论值为1（当速度环带宽足够高时），实际整定中通常取0.8~1.0。
• 加速度前馈：F_aff = Kaff × d²x_cmd/dt²。加速度前馈直接补偿惯性力（F = m × a），可显著减小加减速阶段的跟踪误差。Kaff的理论值为总运动质量（含动子、横梁、负载）与推力常数的比值 m/Kt。

在数字控制系统中，速度和加速度通过对位置指令进行一阶和二阶差分获得。为避免噪声放大，通常需要对前馈信号进行低通滤波，滤波截止频率应高于位置环带宽但低于速度环带宽。

3.3.3 前馈整定的工程步骤

1. 速度前馈整定：施加匀速运动指令（如100 mm/s），观察位置跟踪误差。若误差为恒定正值（滞后），增大Kvff；若误差为负（超前），减小Kvff。调整至稳态误差接近零。
2. 加速度前馈整定：施加梯形速度曲线（含加减速段），观察加减速过程中的动态跟踪误差峰值。若误差峰值在加速段为正、减速段为负，说明Kaff偏小；反之则偏大。逐步调整Kaff直至加减速段的误差峰值最小。
3. 联合微调：速度前馈和加速度前馈存在耦合，需交替调整2~3轮。最终目标是在典型运动轨迹（如S曲线）下，最大跟踪误差降低至纯反馈控制的1/10以下。

3.4 案例拆解：龙门双驱的跟踪误差优化

3.4.1 背景与初始现象

某晶圆键合设备中的龙门双驱平台，X轴行程600 mm，最大速度500 mm/s，加速度2 g（约19.6 m/s²）。初始调试时，采用纯反馈控制（无前馈），位置环带宽12 Hz，速度环带宽200 Hz。在S曲线轨迹运动下，实测最大跟踪误差达到±85 μm，远超设计指标（±5 μm）。同时，两轴同步误差在加减速段达到±20 μm，导致横梁扭转。

3.4.2 分析与诊断

通过伺服分析仪测量位置环开环Bode图，发现穿越频率为12 Hz，相位裕度52°，反馈控制本身稳定。但计算理论跟踪误差：在加速度2g、位置环带宽12 Hz条件下，跟踪误差 ≈ a / (2π × BW_pos)² = 19.6 / (2π × 12)² ≈ 3.4 mm。实际误差85 μm远小于理论值，说明速度环和电流环的快速响应已部分补偿了位置环的滞后，但85 μm仍远超指标。

进一步分析误差波形发现：误差在加速段为正（滞后），匀速段逐渐减小，减速段变为负（过冲）。这是典型的前馈缺失特征——反馈控制无法提前响应指令变化。

3.4.3 前馈参数整定过程

// 整定步骤记录
1. 速度前馈初值：Kvff = 0.9
   → 匀速段误差从 +12 μm 降至 +1.5 μm
2. 加速度前馈初值：Kaff = m/Kt = 45 kg / 120 N/A = 0.375 A/(mm/s²)
   → 加减速段误差峰值从 85 μm 降至 22 μm
3. 微调Kaff至0.40（考虑摩擦补偿）
   → 加速段误差峰值降至 8 μm，减速段误差峰值降至 6 μm
4. 加入低通滤波（截止频率100 Hz）抑制差分噪声
   → 误差峰值稳定在 ±4 μm 以内
5. 同步误差补偿器增益设为位置环增益的0.4倍
   → 同步误差从 ±20 μm 降至 ±3 μm

3.4.4 结果与复盘

复盘经验：前馈参数的整定必须基于对机械模型的理解。Kaff的理论值提供了很好的初值，但实际中需考虑摩擦、电缆拖链阻力和电机推力波动的非线性影响。此外，前馈信号的滤波处理至关重要——过高的滤波截止频率会引入噪声，过低则会削弱前馈效果。在本案例中，最终采用二阶低通滤波（Q=0.7，截止频率100 Hz），在噪声抑制和相位补偿之间取得了平衡。

3.5 常见误区与总结

3.5.1 误区一：盲目追求高带宽

许多工程师认为位置环带宽越高越好，但实际上带宽受限于机械谐振频率。若机械结构存在300 Hz的谐振峰，位置环带宽超过30 Hz后，该谐振峰可能被激励，导致系统啸叫或振荡。正确做法是先通过陷波滤波器抑制谐振，再适当提升带宽。

3.5.2 误区二：忽视电流环的采样同步

在龙门双驱中，两个轴的电流采样必须同步。若采样时刻相差超过几十微秒，在高速运动时会产生明显的推力相位差，导致同步误差增大。现代伺服驱动器支持外部同步信号（如硬件触发），应优先启用。

3.5.3 误区三：前馈系数固定不变

半导体设备中，负载质量可能随工艺变化（如不同尺寸的晶圆）。固定前馈系数在一种负载下最优，在另一种负载下可能产生较大误差。建议在运动控制程序中集成负载辨识功能，根据实际负载自动调整Kaff。