2. XTS动子运动学与坐标系建立

XTS（eXtended Transport System）的动子（Mover）在轨道上运动时，控制系统必须随时知道“每个动子在哪里、朝向如何、速度多大”。这看似简单，但在 XTS 中，轨道既可以是直线段，也可以是圆弧段、曲线段，甚至由多段不同几何形状拼接而成。因此，动子的位置不能只用“走了多少毫米”来描述，而必须建立一套完整的坐标系与运动学模型。本节围绕位置表示、坐标系转换、位置反馈原理以及多工位统一坐标参考四个要点展开。

一、动子位置的两种表示：轨道坐标与全局坐标

XTS 中动子的位置首先以轨道坐标（Track Position）表示，即动子沿轨道中心线从某个基准点（通常取轨道起点或编码器零点）走过的弧长，单位是毫米。轨道坐标是一个一维标量，它天然适合描述“动子沿轨道走了多远”，无论这段轨道是直线还是曲线。例如，一个动子位于轨道坐标 1250.0 mm 处，意味着它沿轨道中心线累计行进了 1250 mm。

但轨道坐标无法直接回答“动子在空间中的哪个位置、朝向哪个方向”。要回答这个问题，需要把轨道坐标映射到全局坐标系（Global Coordinate System）。XTS 的全局坐标系通常以轨道所在平面为 XY 平面，原点设在轨道几何基准点，X 轴和 Y 轴按机械安装方向定义。动子在全局坐标系中的位姿由三个量描述：位置 (x, y) 和朝向角 θ。其中 θ 是动子前进方向与全局 X 轴的夹角。

从轨道坐标 s 到全局位姿 (x, y, θ) 的映射，由轨道的几何参数决定。对于直线段，映射是线性的：x = x₀ + s·cosθ₀，y = y₀ + s·sinθ₀，θ = θ₀。对于圆弧段，映射涉及圆心、半径和起始角：设圆弧圆心为 (xc, yc)、半径为 R、起始角为 φ₀，则 s 对应的角度 φ = φ₀ + s/R，位置为 x = xc + R·cosφ，y = yc + R·sinφ，朝向 θ = φ + 90°（取决于圆弧方向）。曲线段则通常用样条或分段圆弧逼近，映射由控制器内部几何模型完成。

二、动子坐标系与全局坐标系的转换

每个动子自身还带有一个动子坐标系（Mover Frame），原点在动子中心，x 轴指向动子前进方向，y 轴指向动子左侧（或右侧，取决于定义，本文统一取左侧）。动子坐标系用于描述动子上安装的工装、夹具或工件相对于动子的位置。例如，一个夹具在动子坐标系中的位置是 (30 mm, 0 mm)，表示它位于动子中心前方 30 mm 处。

要把动子坐标系中的点转换到全局坐标系，需要经过一次旋转加平移。设动子在全局坐标系中的位姿为 (x, y, θ)，动子坐标系中一点为 (xm, ym)，则它在全局坐标系中的位置为：

x_global = x + xm·cosθ − ym·sinθ
y_global = y + xm·sinθ + ym·cosθ

反过来，已知全局坐标点，也可以反解出动子坐标系中的位置，用于判断某个全局位置是否落在动子的工装范围内。这个转换在多工位同步中非常关键：当多个动子需要把各自的工件送到同一个全局位置时，控制器必须根据每个动子的当前位姿，反算出它们各自需要到达的轨道坐标 s。

三、位置反馈原理

XTS 的位置反馈不是靠动子上的传感器，而是靠轨道上的编码器刻度与动子磁场配合完成。轨道内嵌有周期性磁极或编码器刻度，动子上的永磁体与轨道磁场相互作用产生推力，同时控制器通过测量动子磁场相对于轨道刻度的相位差，解算出动子的绝对位置。这种原理称为“无传感器位置反馈”或“磁编码位置反馈”。

具体来说，XTS 轨道被划分为若干个段（Segment），每段有独立的编码器读头。当动子经过段边界时，位置反馈会从一段切换到下一段。为了保证切换时位置不跳变，控制器会维护一个全局的轨道坐标 s，段边界处的位置值经过标定，确保 s 连续。如果标定不准，动子过段时会出现位置跳变，表现为速度突变或同步误差增大。

位置反馈的分辨率取决于编码器刻度和插值算法。以 Beckhoff XTS 为例，典型位置分辨率可达微米级，速度由位置差分得到，加速度由速度差分得到。控制器内部以固定周期（如 1 ms 或更短）更新位置，形成闭环控制。

四、多工位同步的统一坐标参考

多工位同步的核心问题是：多个动子需要在不同工位同时到达指定位置，或者以相同速度通过某段轨道。如果每个动子各自使用自己的局部坐标，就无法保证同步。因此，必须建立统一的轨道坐标参考。

统一坐标参考的做法是：以轨道起点为 s = 0，沿轨道中心线累计弧长，所有动子的位置都用同一个 s 表示。工位位置也预先标定为轨道坐标值，例如工位 1 在 s = 500 mm，工位 2 在 s = 1200 mm，工位 3 在 s = 2000 mm。同步控制的目标就是让各动子的 s 值在指定时刻满足预定关系。

对于直线段和曲线段混合的轨道，统一坐标参考还需要处理“弧长与直线长度”的换算。控制器内部通常维护一张轨道几何表，记录每段的类型、起点 s、终点 s、几何参数。当需要把全局坐标转换为轨道坐标时，先判断点落在哪一段，再用该段的几何公式反算 s。这张表是 XTS 工程配置中必须正确设置的内容，否则同步精度会受影响。

五、工程配置中的关键参数与检查点

在实际配置 XTS 时，与本节相关的关键参数包括：轨道几何表（每段的类型、长度、圆弧半径、圆心、起始角）、编码器零点偏移、段边界标定值、动子坐标系原点偏移（工装安装位置）。这些参数一旦设置错误，会直接导致位置反馈跳变或同步误差。

建议在调试时按以下顺序检查：第一，确认轨道几何表与实际机械尺寸一致，特别是圆弧段的半径和圆心；第二，手动推动一个动子缓慢通过段边界，观察位置反馈是否连续，若出现跳变则重新标定边界；第三，在全局坐标系中标记一个已知点，用动子坐标系反算轨道坐标，验证转换公式是否正确；第四，多动子同步时，先让两个动子以相同速度运行，观察它们的 s 差值是否恒定，若差值波动则检查各段几何参数是否准确。

下面给出一个简化的轨道几何表示例，用于说明控制器内部如何组织这些数据。表中 s_start 和 s_end 是轨道坐标的起止值，type 是段类型，params 是该段的几何参数。

以表中数据为例，动子位于 s = 1000 mm 时，落在圆弧段 C1 内。该段起始角 φ₀ = -90°，半径 R = 100 mm，则 φ = -90° + (1000 − 800)/100 × (180/π) ≈ -90° + 114.6° = 24.6°。位置 x = 800 + 100·cos(24.6°) ≈ 890.9 mm，y = 100 + 100·sin(24.6°) ≈ 141.6 mm，朝向 θ = φ + 90° ≈ 114.6°。这些数值可用于验证控制器输出的全局位姿是否正确。

总结来说，XTS 动子运动学的核心是“轨道坐标 s 与全局位姿 (x, y, θ) 的双向映射”，而多工位同步的基础是“所有动子共用同一个 s 参考”。理解这两点，就能正确配置轨道几何表、排查位置跳变、并设计出稳定的同步策略。