📚 课程目录第4章 XTS动子运动控制基础

4. XTS动子运动控制基础

XTS（eXtended Transport System）的动子控制并不是“给一个速度就跑”的简单模型。每个动子（Mover）在轨道上都是一个独立的伺服轴，TwinCAT 通过 AX5000 或 AX8000 驱动模块为每个动子建立位置环与速度环，再由 TF5890（XTS 运动控制库）把多个动子组织成可编组的运动对象。理解动子配置、运动命令、双环结构、编组与轨迹规划这五件事，才能让视觉触发真正落到“在正确的位置、以正确的速度、按正确的顺序”执行动作。

一、动子配置：从物理 ID 到逻辑轴

XTS 系统上电后，每个动子通过磁编码或霍尔阵列被识别，TwinCAT 在 XTS System Manager 中为每个动子分配一个物理 ID（Mover ID）。配置阶段需要完成三件事：

动子数量与 ID 映射：确认实际安装的动子数量与工程中 MoverCount 一致，避免“幽灵动子”导致编组失败。
逻辑轴绑定：每个动子映射为一个 AXIS_REF，后续所有运动命令都通过该轴引用下发。
初始位置与方向：定义轨道零点、正方向（通常为顺时针）以及动子初始相位，这是后续位置比较和视觉触发坐标一致性的前提。

配置完成后，可用 MC_Power 使能各动子轴，并通过 XTS_GetMoverInfo 读取每个动子的实际位置、速度和状态字，确认所有动子均处于 Standstill 或 Disabled 的可控状态。

二、运动命令：点动、定位与速度模式

XTS 动子的运动命令分为三类，分别对应不同的控制目标：

命令类型	典型功能块	适用场景
速度模式	`MC_MoveVelocity`	连续输送、同步段匀速运行
定位模式	`MC_MoveAbsolute` / `MC_MoveRelative`	精确停位、视觉检测工位
点动模式	`MC_Jog`	调试、手动对位

速度模式下，动子以设定速度持续运行，直到收到停止或切换命令；定位模式下，动子按梯形或 S 形速度曲线到达目标位置并保持。实际工程中，视觉触发通常发生在速度模式下的“经过窗口”，而抓取/放置动作则依赖定位模式下的“停位窗口”。

三、位置环与速度环：双环如何协同

每个 XTS 动子内部是一个标准伺服控制结构：位置环在外，速度环在内。位置环接收目标位置 SetPos 与实际位置 ActPos 的偏差，输出速度给定 SetVel；速度环再根据速度偏差输出电流/力矩给定，驱动动子沿轨道运动。

关键参数包括：

Kp（位置环增益）：决定位置跟随的刚度，过高会引起振荡，过低会导致跟随误差大。
Kv（速度环增益）：影响速度响应带宽，通常与负载质量和动子数量相关。
前馈：速度前馈和加速度前馈可显著减小动态跟随误差，在视觉触发场景中尤为重要。

视觉触发对位置精度要求高时，建议先整定速度环，再整定位置环，最后加入前馈。整定过程中可用 TwinCAT Scope 观察 SetPos 与 ActPos 的跟随误差曲线。

四、动子编组：从单轴到协同

XTS 的核心优势在于多个动子可以独立运动，也可以编组协同。编组通过 XTS_Group 相关功能块实现，常见形式包括：

刚性编组：多个动子保持固定间距，作为一个整体运动，适合托盘输送。
柔性编组：动子间距可动态调整，适合变节拍、变规格的生产。
主从编组：一个动子作为主轴，其余动子跟随其位置或速度。

编组后，运动命令可下发到组对象，组内动子按规划同步执行。需要注意的是，编组内的动子仍保留各自的位置环，编组层负责协调目标位置和速度给定。

五、轨迹规划：从命令到实际路径

轨迹规划决定了动子“怎么走”。XTS 支持梯形速度曲线和 S 形速度曲线。梯形曲线加速度突变，适合对节拍要求高但机械冲击可接受的场合；S 形曲线加加速度连续，适合对振动敏感、视觉检测精度要求高的工位。

轨迹规划的关键输入包括：目标位置、最大速度、最大加速度、最大加加速度（Jerk）。规划器输出随时间变化的位置、速度、加速度序列，位置环再跟踪该序列。视觉触发点通常定义在轨迹的匀速段或减速段起点，以保证触发时动子速度稳定、位置可预测。

六、工程示例：视觉检测工位的动子运动配置

假设一条 XTS 轨道上有 6 个动子，需要在视觉相机下方以 300 mm/s 匀速通过，并在触发后 50 ms 内完成图像采集。配置思路如下：

在 System Manager 中确认 6 个动子 ID 与 MoverCount=6 一致，绑定 6 个 AXIS_REF。
使用 MC_MoveVelocity 将动子速度设为 300 mm/s，加速度 2000 mm/s²，加加速度 20000 mm/s³。
位置环 Kp 初始设为 20，速度环 Kv 设为 1.5，观察跟随误差；若误差超过 0.5 mm，逐步提高 Kp 并加入速度前馈。
将 6 个动子编为柔性编组，间距根据产品尺寸动态调整。
在轨迹规划中定义触发窗口：当动子位置进入相机视野起点 ±5 mm 时，输出触发信号。

调试时可用 TwinCAT Scope 同时观察 ActPos、SetPos、ActVel 和触发信号，确认触发时刻动子速度稳定在 300 mm/s ±2% 以内，位置重复精度在 ±0.1 mm 以内。若触发时速度波动大，应检查速度环增益和前馈是否匹配；若位置偏差大，应检查位置环增益和机械负载是否一致。

编组内的动子如果负载差异大，位置环增益不能统一设置，否则轻载动子会振荡、重载动子会滞后。建议按负载分组整定，或在编组层使用自适应前馈。

掌握这五个环节后，视觉触发就不再是“碰运气”的时序问题，而是可以量化、可以复现的工程配置。下一步需要把触发信号与动子位置、速度、编组状态关联起来，形成完整的视觉触发逻辑。