3. XTS动子与轨道参数配置
在 TwinCAT 中让 XTS 系统真正“动起来”,第一步不是写运动指令,而是把物理世界里的动子和轨道,准确地映射成软件里的参数模型。XTS 的配置对象主要分两类:一类描述动子(Mover),包括动子类型、长度、磁极间距、编码器标志等;另一类描述轨道(Track),包括轨道几何形状、直线段与圆弧段、位置偏移、方向以及动子的初始位置分配。这些参数一旦定义错误,后续的位置计算、动子寻址和运动控制都会出现偏差,甚至无法使能。
动子类型定义:先建立可复用的“动子模板”
XTS 的动子不是逐个配置的,而是先定义“动子类型”(Mover Type),再让具体动子引用该类型。这样做的意义在于:同一型号的动子共享相同的几何与电气参数,只需维护一份定义。在 TwinCAT 的 XTS 配置界面中,动子类型通常需要填写以下关键参数:
- 动子长度:动子沿轨道方向的物理长度,单位通常为毫米。它决定了动子占用的轨道区间,也影响动子之间的最小间距判断。
- 磁极间距(Pole Pair Length):XTS 动子由永磁体构成,磁极间距是相邻磁极对之间的距离,是电机换向和位置计算的基础参数。
- 编码器标志/位置标志:用于动子位置检测的参考特征,配置时需与硬件实际标志一致。
- 动子质量与负载:影响动力学计算和电流限幅,虽然不直接决定几何位置,但在运动配置中需要一并考虑。
例如,某型号 XTS 动子长度为 100 mm,磁极间距为 60 mm,这些数值必须与 Beckhoff 官方数据手册一致。若手动填写错误,TwinCAT 会在动子位置计算时产生系统性偏差,表现为动子实际停止位置与设定位置始终相差一个固定量。
轨道几何参数:直线段与圆弧段的组合
XTS 轨道由若干几何段组成,常见的是直线段(Line)和圆弧段(Arc)。在 TwinCAT 中配置轨道时,需要按顺序描述每一段的类型和尺寸。直线段需要长度,圆弧段需要半径和圆心角。轨道几何参数决定了整个系统的位置坐标系——所有动子位置都沿轨道弧长方向定义,而不是简单的 X/Y 平面坐标。
以一个典型的“跑道形”轨道为例:两条直线段各长 800 mm,两端各接一个 180° 圆弧段,圆弧半径为 250 mm。则单个圆弧段弧长为 π × 250 ≈ 785.4 mm,轨道总周长约为 2 × 800 + 2 × 785.4 = 3170.8 mm。这个总周长是后续动子位置分配的重要边界:所有动子的位置值都落在 0 到总周长之间。
位置偏移与方向设置:定义坐标原点与运动正方向
轨道几何定义完成后,还需要确定“位置 0 在哪里”以及“哪个方向是正方向”。这就是位置偏移(Offset)和方向(Direction)设置的作用。
位置偏移用于把轨道几何起点平移到实际希望的原点位置。例如,若希望以某条直线段的起点作为位置 0,而几何定义时该点位于圆弧段之后,就需要设置一个偏移量,使坐标系对齐到实际参考点。偏移量可以是正值或负值,TwinCAT 会将其叠加到原始弧长坐标上。
方向设置决定动子沿轨道运动时位置值是递增还是递减。通常约定:沿轨道某一方向运动时位置值增大,该方向即为正方向。方向设置必须与后续运动指令、位置比较和动子分配保持一致。如果方向定义反了,动子虽然能运动,但位置反馈和设定值会呈现相反趋势,导致逻辑判断混乱。
这里需要特别强调参照系的一致性:本节及后续章节中,若无特别说明,均以“轨道弧长坐标”为参照,位置值沿正方向递增,偏移量叠加在几何弧长之上。切换参照系时必须明确说明。
动子初始位置分配:让每个动子有明确的起点
当动子类型和轨道参数都定义好后,最后一步是给每个实际动子分配初始位置。XTS 系统中每个动子都有唯一编号,配置时需要指定该动子在轨道上的初始弧长位置。这个位置是系统上电后动子被识别和使能的基准。
初始位置分配需要注意几点:
- 动子初始位置必须落在轨道总周长范围内,且不能重叠。若两个动子初始位置间距小于动子长度,系统会报冲突。
- 初始位置应尽量避开圆弧段与直线段的交界处,以减少上电识别时的位置不确定性。
- 若动子实际安装位置与配置的初始位置偏差过大,TwinCAT 可能无法正确识别动子,需要重新校准或调整配置。
例如,轨道总周长约 3170.8 mm,配置 4 个动子,动子长度 100 mm。一种合理的初始位置分配为:0 mm、800 mm、1585 mm、2385 mm。相邻间距分别为 800 mm、785 mm、800 mm、785 mm,均远大于动子长度,满足不重叠要求,且分布均匀,便于后续运动规划。
上图展示了跑道形轨道的几何构成与 4 个动子的初始位置分配关系。位置 0 定义在顶部直线段左端,正方向沿顶部直线段向右,经右侧圆弧、底部直线段、左侧圆弧回到起点。动子 M1 至 M4 分别位于 0 mm、800 mm、1585 mm、2385 mm,沿轨道均匀分布,互不重叠。
配置顺序与参数一致性检查
在实际操作中,建议按以下顺序完成配置:先定义动子类型,再定义轨道几何,然后设置位置偏移与方向,最后分配动子初始位置。这个顺序的原因是:动子类型和轨道几何是基础数据,偏移和方向依赖几何定义,而初始位置又依赖前三者。如果顺序颠倒,容易出现参数引用不到或数值范围错误。
配置完成后,应做一次一致性检查:
- 核对动子长度与磁极间距是否与硬件手册一致。
- 核对轨道各段长度、半径、角度是否与机械图纸一致。
- 确认位置偏移量叠加后,所有动子初始位置仍在 0 到总周长范围内。
- 确认方向设置与后续运动指令的正方向约定一致。
- 检查动子初始位置之间是否有足够间距,避免重叠冲突。
完成本节配置后,XTS 系统就具备了可用的位置模型。后续的动子使能、运动指令和位置控制,都建立在这套参数之上。参数越准确,后续调试越顺畅。