📚 课程目录第2章输送链跟踪核心原理

2. 输送链跟踪核心原理

输送链跟踪的本质，是让机器人在一条持续运动的输送链上，对随链移动的工件完成“像静止一样”的抓取或加工。要做到这一点，机器人必须同时掌握三件事：链走了多远、工件在哪里、机器人自己该往哪儿动。这三件事分别由编码器信号、工件坐标系和机器人运动叠加来回答，而跟踪窗口与同步区则规定了“什么时候可以开始跟、跟到哪里必须结束”。

一、编码器信号：把链的位移变成机器人能读懂的“尺子”

输送链跟踪的第一手信息来自安装在链驱动轴或链轮上的编码器。编码器每转过一个固定角度输出一个脉冲，脉冲数与链的直线位移成正比。ABB 机器人通常通过 DSQC 377A 等编码器接口板或现场总线读取该信号，并在系统内建立一个“输送链对象”（Conveyor）。

关键参数是每米脉冲数（pulses per meter）或每脉冲位移（mm/pulse）。例如，某链轮节圆直径 200 mm，编码器 1024 线、四倍频后为 4096 脉冲/转，则链轮每转一圈链移动 π×200≈628.3 mm，每脉冲位移约为 628.3/4096≈0.153 mm。这个数值必须准确标定，否则跟踪时机器人会“越跟越偏”。

编码器信号还承担方向判断。ABB 系统中通过 A/B 两相正交信号区分链的正向与反向，使机器人能识别链是前进还是回退。若方向接反，跟踪窗口的进入条件会完全错乱，表现为机器人提前或滞后动作。

二、工件坐标系：把“链上的点”翻译成机器人坐标

编码器只告诉机器人链走了多少，但机器人还需要知道工件相对于链的固定位置。这由工件坐标系（Work Object）完成。在输送链跟踪中，通常建立一个与链运动方向对齐的工件坐标系：原点设在链上某个基准点，X 轴沿链运动方向，Z 轴垂直向上。

当工件随链移动时，机器人在该工件坐标系下看到的工件位置是“相对静止”的。也就是说，机器人不需要每时每刻重新示教工件位置，只需在标定时确定工件在链坐标系中的初始位姿，之后由编码器增量实时修正。ABB 的 wobj 数据中，ufmec 与 oframe 共同描述了这个关系。

标定要点：工件坐标系的原点应选在链上可重复到达的基准位置，X 轴方向必须与链实际运动方向一致。方向偏差 1°，在 1 m 跟踪距离上就会产生约 17 mm 的横向误差。

三、跟踪窗口与同步区：规定“能跟多远、必须跟多准”

机器人不是无限范围都能跟踪。每条链都定义了一个跟踪窗口（Tracking Window），通常用链坐标下的一个区间表示，例如从 0 mm 到 1200 mm。只有当工件进入这个区间，机器人才能开始跟踪；超出窗口，跟踪必须结束或放弃。

在窗口内部，还有一个更严格的同步区（Synchronization Zone）。同步区是机器人实际与工件保持同步运动、执行抓取或加工动作的区域。同步区通常比跟踪窗口窄，例如窗口 0～1200 mm，同步区设为 200～900 mm。这样做的目的是留出进入同步前的加速段和退出同步后的减速段，避免机器人在窗口边缘因速度突变而报警或丢步。

可以用一个简单的关系来理解：
跟踪窗口 = 允许开始跟踪的范围；同步区 = 必须保持同步的范围。
工件先进入跟踪窗口，机器人开始“关注”；进入同步区后，机器人速度与链速一致，执行动作；离开同步区后，机器人减速退出；离开跟踪窗口后，本次跟踪结束。

四、机器人运动叠加：链速 + 机器人自身运动

跟踪过程中，机器人的实际运动是两部分叠加的结果：

链的牵连运动：工件随链以速度 v_chain 移动；
机器人相对工件的运动：机器人在工件坐标系下执行抓取、放置或加工轨迹。

因此，机器人末端在空间中的绝对速度约为 v_robot = v_chain + v_relative。如果机器人只跟随不动作，v_relative=0，机器人末端与工件保持相对静止；如果机器人还要在工件上走一段轨迹，则 v_relative 由程序轨迹决定，但机器人控制器会自动把链速补偿进去。

ABB 机器人通过 Conveyor 对象和 WaitWObj、SyncToSensor 等指令实现这一叠加。实际调试时，最直观的观察点是机器人 TCP 在工件坐标系下的位置是否稳定：如果稳定，说明叠加正确；如果 TCP 在工件上“漂移”，说明编码器标定、工件坐标系或同步区参数存在偏差。

五、五个概念如何协同工作

把上述概念串起来，一次完整的跟踪过程可以这样理解：

编码器持续输出脉冲，机器人实时计算链的位移增量；
工件坐标系把链位移映射为工件在机器人坐标系下的实时位姿；
当工件进入跟踪窗口，机器人开始准备；
进入同步区后，机器人速度与链速同步，执行抓取或加工；
离开同步区后减速退出，离开跟踪窗口后本次跟踪结束。

实际调试中，最常见的偏差来源是编码器标定不准、工件坐标系 X 轴与链方向不平行、同步区设置过宽导致机器人超速。建议先用低速（如链速 100 mm/s）验证 TCP 在工件坐标系下的稳定性，再逐步提速到生产速度。若发现 TCP 在工件上沿链方向漂移，优先检查每米脉冲数；若发现横向偏移，优先检查工件坐标系方向。

注意：跟踪窗口和同步区的数值必须根据机器人最大速度、加速度和链速共同确定。同步区长度 L 与链速 v_chain、机器人加速时间 t_acc 的关系应满足 L ≥ v_chain × t_acc，否则机器人来不及在同步区内达到链速，会触发跟踪误差报警。

理解这五个概念之后，后续的输送链标定、跟踪程序编写和同步参数调试，本质上都是在回答同一个问题：机器人如何在正确的时间、正确的位置，以正确的速度叠加到链的运动上。