4. mover同步控制核心概念

在XTS系统中，mover本身是一个个独立的伺服轴，每个mover都有自己的位置环、速度环和电流环。所谓“同步控制”，并不是让多个mover共享同一个物理轴，而是通过软件方式建立mover之间的运动约束关系，使它们在时间与空间上保持确定的相对位置或速度关系。理解主从同步、电子齿轮、电子凸轮、位置耦合与速度前馈这五个概念，是后续编写同步程序、调试同步精度的基础。

一、主从同步：谁定义运动，谁跟随运动

主从同步是最基本的同步结构。系统中指定一个mover作为主轴（Master），它的运动由外部指令、轨迹规划或上位机给定；其他mover作为从轴（Slave），其目标位置由主轴位置经过某种映射关系计算得到。从轴不独立规划轨迹，而是“读取主轴位置，再决定自己该在哪里”。

在TwinCAT中，主从关系通常通过MC_GearIn、MC_CamIn或MC_MoveSync等PLCopen运动控制功能块建立。以MC_GearIn为例，调用时需要指定主轴轴对象、从轴轴对象、齿轮比（RatioNumerator/RatioDenominator）以及同步模式（如MC_SYNC_MODE_IMMEDIATE或MC_SYNC_MODE_BUFFERED）。同步建立后，从轴位置满足：

SlavePos = MasterPos × (RatioNumerator / RatioDenominator) + Offset

这里的Offset是同步建立瞬间从轴与主轴之间的位置偏置，用于保持从轴当前实际位置不跳变。实际工程中，如果从轴在同步前已经处于某个位置，而齿轮比计算出的目标位置与当前位置不一致，系统会在同步过程中自动补偿这个差值，补偿过程受同步速度、加速度限制。

二、电子齿轮：速度比例关系的数字化实现

电子齿轮是主从同步中最常用的一种耦合方式，它建立的是主轴与从轴之间的速度比例关系。传统机械齿轮通过齿数比决定转速比，电子齿轮则用分子/分母参数在软件中实现同样的效果，且比例可以实时修改、无需更换硬件。

假设主轴mover以300 mm/s运行，齿轮比设为2:1，则从轴目标速度为600 mm/s。如果齿轮比设为1:3，从轴速度则为100 mm/s。在XTS中，齿轮比不仅影响速度，也影响位置累积关系——从轴位置始终等于主轴位置乘以齿轮比再加上偏置。因此电子齿轮本质上是一种“位置耦合”，只是工程上更习惯从速度比例的角度去理解它。

需要注意的是，电子齿轮建立时如果主轴正在运动，从轴需要经历一个“同步过渡”过程。TwinCAT中可以通过SyncMode参数选择立即同步或缓冲同步，并设置同步速度、同步加速度。过渡完成后，从轴才真正进入齿轮耦合状态，此时MC_GearIn功能块的InGear输出为TRUE。

三、电子凸轮：位置与位置的函数映射

电子凸轮比电子齿轮更灵活。齿轮比是固定比例，而凸轮允许从轴位置是主轴位置的任意函数：

SlavePos = CamTable(MasterPos)

这个函数通常以凸轮表（Cam Table）的形式给出，表中存储若干组“主轴位置—从轴位置”对应点，中间通过插值（线性、三次样条等）计算。电子凸轮适合实现非匀速、非线性的同步动作，例如：主轴走100 mm时从轴先快速前进、再停顿、再缓慢后退，这种复杂运动用齿轮无法表达，但用凸轮表可以精确描述。

在XTS中，凸轮表可以通过TwinCAT Cam Design Tool生成，也可以由PLC代码动态写入。调用MC_CamIn时指定凸轮表ID、主轴偏移、从轴偏移以及同步模式。凸轮同步建立后，从轴位置完全由主轴位置查表决定，主轴反向运动时从轴也会按凸轮曲线反向运动。

四、位置耦合与速度前馈：同步精度的两个关键

位置耦合是主从同步的本质——从轴的目标位置由主轴位置计算而来，两者之间存在确定的数学关系。但仅有位置耦合还不够。从轴伺服环在跟踪目标位置时存在滞后，尤其在主轴高速运动或加速度较大时，从轴实际位置会落后于目标位置，造成同步误差。

速度前馈（Velocity Feedforward）就是用来补偿这种滞后的。它的做法是：在从轴位置环之前，直接把主轴速度乘以齿轮比（或凸轮斜率）得到从轴的理论速度，作为前馈量叠加到速度指令上。这样从轴速度环不需要等位置误差累积到一定程度才响应，而是提前获得速度指令，从而大幅减小跟踪误差。

在TwinCAT中，速度前馈通常通过MC_GearIn或MC_CamIn的VelocityFeedforward参数启用，也可以在轴参数中设置前馈增益。前馈量过小，同步误差大；前馈量过大，可能引起速度超调或振荡。工程上一般先设100%理论前馈，再根据实际跟随误差微调。

五、五个概念在实际工程中的配合方式

在一个典型的XTS同步工位中，这五个概念往往同时出现。例如：主轴mover负责输送工件，从轴mover负责在工件上完成贴标动作。工程师首先用MC_GearIn建立主从同步，让从轴以1:1速度跟随主轴；然后在贴标区间切换到MC_CamIn，用凸轮表让从轴在跟随过程中完成“下降—贴标—上升”的复合动作；同时启用速度前馈，保证贴标瞬间从轴与工件之间没有相对滑动。

调试时，可以通过TwinCAT Scope View同时观察主轴位置、从轴目标位置、从轴实际位置和跟随误差。如果跟随误差在加速段明显增大，说明速度前馈不足；如果从轴在同步建立瞬间出现位置跳变，说明Offset或同步模式设置不当；如果凸轮区间内从轴动作与预期不符，则需要检查凸轮表的插值方式和主轴偏移量。

六、参数设置示例

以下是一个电子齿轮同步的典型参数配置示例（数值为教学假设，非实测结果）：

同步建立后，通过MC_GearIn的InGear信号判断是否进入稳定耦合状态。若InGear长时间为FALSE，应检查主轴是否使能、从轴是否处于错误状态、同步速度是否过小导致过渡时间过长。进入稳定耦合后，再观察跟随误差是否在允许范围内，通常XTS应用中要求同步误差小于0.1 mm，具体指标取决于工艺精度要求。