3. 输送链跟踪工作原理

输送链跟踪的本质，是让机器人在一个“会动的世界”里保持对工件的相对静止。要理解这一点，需要把整条链路拆成四个相互衔接的环节：编码器把链条的机械位移变成电脉冲，控制器把脉冲换算成工件位置，运动规划把工件位置映射为机器人末端的目标轨迹，而跟踪坐标系则规定了这一切计算所依据的参照基准。四者缺一不可，任何一环的偏差都会直接表现为抓取点偏移或跟踪抖动。

一、编码器信号采集：把链条位移变成可计数的脉冲

输送链跟踪的起点是编码器。工程上最常用的是增量式旋转编码器，安装在链条驱动轴或张紧轮上，链条每前进一段距离，编码器就输出固定数量的脉冲。这里有两个关键参数：编码器分辨率（每转脉冲数 PPR）和驱动轮周长（或链轮节圆周长）。二者共同决定了“一个脉冲对应链条走多远”，即脉冲当量：

脉冲当量 = 链轮节圆周长 / (PPR × 倍频系数)
示例：节圆周长 400 mm，PPR = 1000，4 倍频
脉冲当量 = 400 / (1000 × 4) = 0.1 mm/脉冲

采集环节要解决三件事。第一是信号形式：编码器通常输出 A、B 两相正交脉冲，通过判断 A、B 的相位先后即可识别链条正反向；Z 相为每转一次的零位脉冲，用于消除累计误差。第二是接入方式：高速计数模块直接接收 A/B/Z 信号，由硬件完成四倍频和方向判别，避免软件轮询丢脉冲。第三是抗干扰：编码器线应采用屏蔽双绞线，屏蔽层单端接地，与伺服动力线分开走线，否则脉冲丢失会直接造成位置跳变。

需要特别注意的是，跟踪计算使用的是“脉冲增量”而非绝对位置。控制器每个扫描周期读取一次当前计数值，与上一周期相减得到增量，再乘以脉冲当量，就得到本周期链条前进的距离。这种增量式处理天然适应链条的连续运动，但也要求计数不能溢出或回绕。

二、工件位置计算：从脉冲到跟踪坐标系下的坐标

仅有链条位移还不够，控制器必须知道“工件相对于机器人基座在哪里”。这需要建立一条坐标传递链。工件在输送链上随链条一起运动，其位置由两部分叠加而成：一是工件被视觉或光电开关检测到的那一刻所记录的链条位置，二是此后链条继续前进的增量。

设工件在检测时刻的链条位置为 L₀，当前链条位置为 L，则工件沿链条方向的位移为 ΔL = L − L₀。再结合输送链相对于机器人基座的安装关系——链条中心线与机器人基座的距离、链条运行方向与机器人 X 轴的夹角——即可把 ΔL 投影到机器人基座坐标系中：

工件在基座坐标系下的位置：
X_w = X₀ + ΔL · cosθ
Y_w = Y₀ + ΔL · sinθ
Z_w = Z₀（由输送链台面高度决定）
其中 (X₀, Y₀, Z₀) 为检测点对应的工件初始位置，θ 为链条运行方向角。

实际工程中，视觉系统往往直接给出工件在相机坐标系下的位姿，再通过手眼标定矩阵转换到机器人基座坐标系。此时链条位移 ΔL 作为修正量叠加到视觉结果上，用于补偿“拍照时刻”到“抓取时刻”之间工件已经移动的距离。这一步是跟踪精度的核心：如果 ΔL 计算滞后一个扫描周期，在 0.5 m/s 的链速下，10 ms 的滞后就意味着 5 mm 的抓取偏差。

三、机器人运动同步：让末端与工件“同速同向”

知道了工件位置，接下来要让机器人末端在抓取瞬间与工件保持相对静止。这要求机器人末端速度矢量与工件速度矢量一致。工件速度由链条线速度决定，方向沿链条运行方向。控制器据此在机器人运动指令中叠加一个“跟踪速度分量”，使末端在接近工件的过程中逐渐加速到与链条同速，并在抓取窗口内保持该速度。

同步过程通常分为三个阶段：接近段，机器人从等待位快速运动到工件前方；同步段，末端速度与链条速度匹配，位置误差收敛到允许范围内；抓取段，在同步窗口内闭合夹爪并随工件继续运动一小段距离，确认抓稳后再抬起脱离。同步段的时间窗口由链速和机器人加速度共同决定，链速越高，可用窗口越短，对机器人动态性能要求越高。

四、跟踪坐标系建立：统一所有计算的参照基准

跟踪坐标系是整条链路的“公共语言”。它通常定义在输送链上，原点取在链条中心线与机器人工作区入口的交点，X 轴沿链条运行方向，Z 轴垂直向上，Y 轴由右手定则确定。所有工件位置、机器人目标点和速度分量都在这个坐标系下表达，再通过固定的变换矩阵转换到机器人基座坐标系。

建立跟踪坐标系需要标定三个量：链条中心线相对于机器人基座的位置、链条运行方向角 θ、以及输送链台面高度。标定方法可以用机器人末端带尖点依次触碰链条上的多个已知点，记录基座坐标后拟合出直线和平面。标定完成后，跟踪坐标系与基座坐标系之间的变换矩阵就固定下来，后续所有跟踪计算都基于它进行。

五、四个环节的时序配合与常见问题

把四个环节串起来看，它们存在严格的时序依赖。编码器采集必须在每个控制周期内完成，工件位置计算必须使用与采集同一时刻的脉冲值，运动同步必须基于最新的工件位置，而跟踪坐标系则贯穿始终。任何一环的延迟都会向后传递。工程上常见的跟踪偏差，多数不是机器人本身精度不够，而是时序配合出了问题。

理解这条链路之后，再看跟踪参数就会清楚每一项的作用：脉冲当量决定位置换算的比例，方向角决定坐标投影的方向，同步窗口决定抓取的时间余量，而跟踪坐标系决定所有计算的基准。四者共同构成输送链跟踪的工作原理，也是后续编程与调试的直接依据。