2. 输送链跟踪核心概念
输送链跟踪的本质,是让机器人在一个“会动的世界”里完成原本在静止工位上定义好的动作。要理解这件事,必须先弄清四个核心概念:编码器、线速度、跟踪坐标系、工件坐标系,以及它们之间的同步关系。这四个概念不是并列的知识点,而是一条从“感知运动”到“定义位置”再到“保持同步”的完整链条。
编码器:把链的位移变成机器人能读懂的脉冲
输送链跟踪的第一手信息来自编码器。编码器通常安装在输送链的驱动轴、张紧轴或独立的测量轮上,链子每移动一段距离,编码器就输出一定数量的脉冲。机器人控制器并不直接“看见”链子走了多少毫米,它看到的是脉冲计数。因此,编码器分辨率决定了跟踪的最小位移单位。
假设编码器为 1000 脉冲/转,测量轮周长 200 mm,则每个脉冲对应的链位移为 200 ÷ 1000 = 0.2 mm。这个值就是跟踪系统的位移当量。如果链速为 300 mm/s,则脉冲频率约为 1500 Hz。控制器通过单位时间内的脉冲增量计算链的实时速度,通过累计脉冲数计算链的累计位移。这里有一个关键约定:脉冲增量的正负号必须与链的实际运动方向一致。若编码器接线反相,链向前走而脉冲递减,跟踪坐标系就会反向漂移,机器人会“追着链子往回跑”。
线速度:跟踪的“时间基准”
线速度是链在单位时间内走过的距离,单位通常为 mm/s 或 m/min。它决定了机器人必须在多长时间内完成跟踪动作。线速度的获取有两种方式:一是由编码器脉冲频率实时计算,二是由控制器从编码器累计位移做差分得到。前者响应快,后者更平滑。
线速度在跟踪中承担三个作用:第一,计算跟踪坐标系随时间的位移量;第二,判断链是否处于稳定速度区间,避免在加减速阶段触发跟踪;第三,作为同步关系的“时间基准”——机器人末端在跟踪坐标系中的运动速度,必须与链的线速度在跟踪方向上保持一致,否则工件会在机器人手中“滑动”。
例如,链速 300 mm/s,机器人跟踪行程 400 mm,则理论跟踪时间约为 1.33 s。若机器人实际完成该行程需要 1.5 s,说明机器人运动速度不足,工件会在跟踪过程中相对机器人末端前移,抓取点就会偏离。此时应降低链速、缩短跟踪行程或提高机器人速度倍率。
跟踪坐标系:随链移动的“动态参考系”
跟踪坐标系是输送链跟踪中最核心的概念。它不是一个固定坐标系,而是一个随链位移实时更新的坐标系。通常以编码器零点或链上某个基准位置为原点,X 轴沿链运动方向,Y 轴垂直于链运动方向,Z 轴按右手定则确定。
跟踪坐标系与普通用户坐标系的最大区别在于:它的原点位置是时间的函数。控制器每个插补周期都会根据编码器累计位移更新跟踪坐标系原点,使机器人末端在跟踪坐标系中的目标点保持不变,而在世界坐标系中,机器人末端则随链一起移动。这就是“机器人跟着链走”的数学本质。
跟踪坐标系的方向定义必须与编码器方向一致。若链沿 X 正方向运动,编码器脉冲递增,则跟踪坐标系原点沿 X 正方向平移;若链反向,原点沿 X 负方向平移。方向约定一旦确定,全文和程序中的正负号都应保持一致。
工件坐标系:工件在链上的“身份坐标”
工件坐标系描述的是工件相对于链面或托盘的位置。它通常由视觉系统、光电开关或机械定位装置确定。工件坐标系与跟踪坐标系的关系是:工件坐标系固定在工件上,随工件一起随链运动;跟踪坐标系固定在链的基准位置上,也随链运动。两者之间的相对关系在工件未被移动时应保持不变。
实际工程中,常见的做法是:先示教一个“跟踪基准点”,再通过视觉或传感器测量工件相对于该基准点的偏移量,把这个偏移量写入工件坐标系。机器人抓取时,目标点 = 跟踪坐标系中的基准点 + 工件坐标系偏移量。这样,即使工件在链上的摆放位置有微小差异,机器人也能准确抓取。
同步关系:四个概念如何协同工作
把上述概念串起来,就得到输送链跟踪的同步关系:编码器提供位移和速度,线速度提供时间基准,跟踪坐标系提供动态参考系,工件坐标系提供工件位置。四者必须满足以下同步条件:
- 方向同步:编码器计数方向、跟踪坐标系 X 轴方向、链实际运动方向三者一致。
- 速度同步:机器人末端在跟踪方向上的速度分量等于链的线速度。
- 位置同步:机器人末端在跟踪坐标系中的目标点与工件坐标系中的抓取点重合。
- 时间同步:机器人进入跟踪区的时刻与工件到达抓取点的时刻匹配,避免“追空”或“撞件”。
下面用一张关系图表示这四个概念之间的数据流与同步约束。图中左侧是感知层,中间是坐标层,右侧是执行层,箭头表示信息传递方向,虚线表示同步约束。
一个可执行的同步检查示例
在实际调试中,可以用以下参数表快速核对同步关系。表中数值为教学示例,实际工程需按现场编码器、链速和机器人型号重新标定。
| 检查项 | 示例值 | 判断依据 |
|---|---|---|
| 编码器分辨率 | 1000 脉冲/转 | 与测量轮周长匹配,位移当量 0.2 mm/脉冲 |
| 链线速度 | 300 mm/s | 稳定区间内波动小于 ±5% |
| 跟踪行程 | 400 mm | 理论跟踪时间 1.33 s |
| 机器人跟踪速度 | ≥300 mm/s | 低于链速则工件相对末端前移 |
| 方向一致性 | 链前进时脉冲递增 | 若递减则取反编码器方向 |
| 抓取点偏差 | ≤±1 mm | 超出则检查工件坐标系偏移量 |
理解这四个概念及其同步关系后,后续的编码器接线、跟踪参数配置、程序示教和异常排查都会变得有据可依。方向、速度、位置、时间这四个同步条件,也是判断跟踪是否成功的最终标准。