3. 输送链跟踪技术原理
输送链跟踪（Conveyor Tracking）是机器人从运动中的输送链上抓取或放置工件的核心技术。它的本质可以概括为一句话：机器人必须知道“工件现在在哪里”，并且能在自己运动的过程中，让工具始终“追上”这个不断移动的目标。要理解这一点，需要把四个基本概念串起来：编码器信号、跟踪坐标系、工件坐标系，以及线速度与位置同步。
一、编码器信号：把“链走了多远”变成“脉冲数”
输送链本身不会告诉机器人它移动了多少，必须依靠安装在链驱动轴或链轮上的编码器来测量。编码器每转过一个固定角度就输出一个脉冲，因此脉冲数与链的位移成正比。设编码器分辨率为 R（脉冲/转），链轮节圆直径为 D（mm），则每个脉冲对应的链位移为：
每脉冲位移 = π × D / R （mm/脉冲）
示例：D = 200 mm，R = 4096 脉冲/转
每脉冲位移 = 3.1416 × 200 / 4096 ≈ 0.1534 mm/脉冲这个数值就是跟踪系统的“标尺”。ROBOGUIDE 中配置输送链时，需要输入编码器分辨率、链轮直径或每脉冲位移，以及编码器计数方向。方向非常关键：如果链实际向前运动，而编码器计数在减小，跟踪就会反向，机器人会朝错误方向追。通常约定链运动方向为正向，编码器计数递增，并在配置中通过取反参数统一。
编码器信号进入机器人控制器后，一般以两种形式被使用：一是累计脉冲数，用于计算链的绝对位移；二是脉冲频率（单位时间脉冲数），用于计算链的实时线速度。ROBOGUIDE 的输送链仿真中，可以用一个虚拟编码器按设定速度产生脉冲，模拟真实链的运动。
二、跟踪坐标系：机器人“看链”的参考框架
跟踪坐标系（Tracking Frame）是定义在输送链上的一个坐标系，它随链一起运动。它的作用是把编码器测得的链位移，转换成机器人可以理解的空间位置变化。跟踪坐标系通常包含：
- 原点：一般设在链上某个基准点，例如跟踪起始位置或工件检测传感器触发点；
- X 轴：通常沿链运动方向；
- Y 轴：沿链宽度方向；
- Z 轴：垂直于链平面向上。
当链移动距离 Δs 时，跟踪坐标系沿 X 轴平移 Δs。机器人控制器内部维护这个动态坐标系，并据此实时更新目标工件的位置。ROBOGUIDE 中，跟踪坐标系需要与输送链的几何模型对齐，否则会出现“工件在链上，但机器人抓偏”的现象。
三、工件坐标系：机器人“抓哪里”的局部框架
工件坐标系（Work Object / Part Frame）是定义在工件上的坐标系，描述工件相对于跟踪坐标系的位置和姿态。它决定了机器人工具以什么姿态、从哪个方向去抓取工件。工件坐标系通常由工件检测传感器触发时确定：当传感器检测到工件到达某个位置，控制器记录此时编码器值，并结合工件在链上的标定位置，计算出工件坐标系在跟踪坐标系中的偏移。
这里有一个容易混淆的点：跟踪坐标系随链运动，工件坐标系相对跟踪坐标系固定。也就是说，工件一旦被检测到，它在跟踪坐标系中的位置就不再变化；链动，跟踪坐标系动，工件坐标系跟着动，机器人目标点也随之移动。
四、线速度与位置同步：让工具“追上”工件
线速度同步是指机器人工具在抓取瞬间的速度，必须与输送链的线速度一致。设链速为 v（mm/s），机器人工具在跟踪方向上的速度为 vt，则要求：
v_t = v （速度同步条件）
示例：链速 v = 150 mm/s
机器人工具在跟踪方向的速度也必须为 150 mm/s位置同步则要求机器人在抓取时刻，工具中心点（TCP）与工件坐标系的原点重合。由于工件在动，机器人不能“等”工件过来，而必须提前规划一条与链运动匹配的轨迹。实际实现中，控制器会根据编码器实时更新的工件位置，不断修正机器人目标点，使 TCP 与工件之间的相对位置误差趋近于零。
下面这张图把四个概念放在同一条信号与坐标关系链上，帮助理解它们如何协同工作：
五、四个概念如何协同：一次抓取的时间线
把上述概念放到一次实际抓取中，可以这样理解：
- 链以恒定线速度 v 运动，编码器持续输出脉冲，控制器累计得到链位移 Δs；
- 工件检测传感器被触发，控制器记录当前编码器值，并据此建立工件坐标系；
- 跟踪坐标系随链移动，工件坐标系相对跟踪坐标系保持不变；
- 机器人根据工件坐标系的实时位置，规划一条速度与链速匹配的轨迹；
- 在抓取点，TCP 与工件坐标系原点重合，且 vt = v，完成同步抓取。
在 ROBOGUIDE 中验证这些概念时，可以先用一个固定速度的虚拟编码器驱动输送链，观察跟踪坐标系是否随链平移；再放置一个工件并触发虚拟传感器，检查工件坐标系是否在触发时刻被正确建立；最后运行跟踪程序，观察机器人 TCP 在抓取点的速度与位置是否与链匹配。通过这种“分步观察”的方式，可以把四个抽象概念逐一对应到仿真中的可见现象上。