简介FANUC 机器人在线追踪Line Tracking调试中文手册主要面向工业机器人集成商、现场调试及维护工程师。内容以 R-30iB / R-30iB Mate 控制器为主线系统讲解在线追踪功能的安全规范、操作流程、安装调整与维护检查方法。手册从操作员、程序员与维修工程师的职责划分讲起重点覆盖机器人意外启动、机械臂碰撞等危险场景并给出安全栅栏联锁、急停端子连接、外部信号确认等具体防护方案同时包含低速试运行、定期润滑与数据备份等实用建议。资源为1个PDF文件总大小6.94MB便于按章节查阅。目前已有409人学习下载适合需要规范化调试FANUC 机器人、补齐安全操作知识的工程师参考。1. FANUC-LINE-TRACKIN 是什么给流水线上“动着干”的机器人补课反直觉的结论先放在前面FANUC 的 LINE TRACKING 不是让机器人沿着地面漆线走而是让机器人在传送带还开着的时候追上正在移动的工件边随动边抓取。产线不停机节拍才能算得过来。标题里那份中文 PDF 是不少自动化工程团队案头常备的资料名字直接叫 FANUC-LINE-TRACKIN实际讲的就是这套输送线同步跟踪功能。对维修电气、机器人调试、PLC 工程师来说搞懂它意味着不必为了一个工件把整条线停下。下面按“坐标与接线 → 参数配置 → 程序结构 → 现场调试”的顺序把这件事说透。2. LINE TRACKING 的坐标系和编码器定位不止靠视觉很多第一次接触 FANUC 线跟踪的人会以为装了视觉才能干这活实际不是。视觉能给出工件在传送带平面的二维偏移但机器人拿到的“工件来了”信号大多是编码器读出的传送带位移再换算成跟踪组坐标系的增量。要保证抓得准先得把坐标系和编码器关系理清。2.1 跟踪组离不开三个坐标系传送带、工件、机器人跟踪组Tracking Group是 FANUC 里一套把编码器脉冲转换为机器人位置偏移的数据结构。常见配置是 1 到 3 组每组内部至少涉及三个坐标系传送带坐标系、工件坐标系、机器人基坐标系。工件在传送带坐标系下的位置由编码器脉冲实时累计机器人把目标点从工件系换算到自身基系。换算公式的核心是每脉冲位移和跟踪方向这两个值一旦有误差后面程序写得再漂亮也会抓偏。机器人控制器每隔一个固定周期读取编码器计数计算出传送带当前位置。这套机制不要求视觉持续参与只要工件一开始到定位点后续追赶完全靠编码器增量。所以光电开关、接近开关这类传感器只需告诉机器人“工件到了跟踪区”长距离跟踪精度由编码器负责。电气信号从光电开关到控制器有一定滞后通常在调用跟踪子程序前先做一个固定的等待时间等工件进入有效跟踪区再启动。坐标系标定时除了常规的三点法还要额外指定传送带运动方向轴。这里最常见的错误是把传送带运动方向标成了机器人 X 轴的正向结果机器人沿着传送带方向追的时候目标点偏移始终叠加在错误的轴上。用示教器做坐标校验时可以手动移动传送带一小段看工件坐标系下的 X 值是否单调增长。如果看到数值反向就要回到方向参数修正。2.2 编码器怎么接差分信号、A/B 相与零点编码器一般接机器人的内置 I/O 板或独立位置模块。优先选择带差分输出的编码器A、B 相差分可以同时得到方向Z 相零点用于回零。接线时注意把屏蔽层单端接地避免变频器干扰。如果控制器检测不到脉冲先用示教器看相关输入状态再量 A/B 相电压。常见 5V TTL 和 24V HTL 不一样千万别直接混接否则可能烧输入口。提示编码器信号不是接到普通数字输入口而是位置模块或专用高速计数口。接普通 DI 只能看到 0/1无法读到连续脉冲数。接线完成后FANUC 提供的“系统连接测试”里能看到通道的实时计数。传送带手动移动时计数应随方向增减。计数不变化先查编码器供电再查 A/B 相是不是接反或者焊接处开路了。这一步属于硬件检查不需要做任何参数修改但能筛掉七成接线错误。2.3 一表搞定标定每脉冲位移的计算与验证跟踪组参数里必填的一项叫每脉冲位移。它由编码器分辨率、减速机速比和驱动轮直径共同决定。公式是每脉冲位移 π × 驱动轮直径 /编码器每转脉冲数 × 减速比。算完后还要实测校正因为轮子打滑和直径磨损都会让理论值失效。下面的表是一组常见参数参数示例值说明编码器分辨率1000 P/R编码器每转脉冲数减速比30:1驱动轴转 1 圈编码器转 30 圈驱动轮直径120 mm轮子与传送带接触的实际直径每脉冲位移理论值0.0126 mm按公式计算得到你可以用下面这段 Python 在电脑上先算出理论值import math pulse_per_rev 1000 gear_ratio 30 wheel_diameter_mm 120 mm_per_pulse (math.pi * wheel_diameter_mm) / (pulse_per_rev * gear_ratio) print(f理论每脉冲位移: {mm_per_pulse:.4f} mm)这段代码先计算轮子周长再除以每完整圈对应的总脉冲数结果是理论值。把结果填进 FANUC 跟踪组之前一定要实际跑一段传送带验证。常用方法是在传送带上做两个标记点用卷尺量出 500 mm手动移动传送带并通过示教器记录脉冲数用实际距离反推每脉冲位移。理论值帮你缩小量程实际值才是真正填进控制器的那一个。3. 在示教器里配置跟踪组LINE-TRACKIN 参数这样填配置线跟踪的位置在控制器设置菜单里不是自动生成的。很多新项目打开菜单发现是灰的第一反应是选项没装好其实要先在 Controlled Start 模式下把跟踪选项激活。进入示教器 MENU → SETUP → Tracking Groups如果能看到 Group 1、2、3说明功能已经启用。看不到就检查系统选项里有没有加上跟踪软件包。3.1 打开 Tracking Group 菜单把第 1 组激活选择 Group 1按 F3 编辑。这里需要关联编码器输入口和使能信号。使能信号通常是一个数字输入 DI用来告诉机器人“传送带正在运动”。如果做成常闭当 DI 从 ON 变 OFF 时就会生成跟踪中断。建议给每个组单独配一个 DI不要复用急停回路里的信号避免电气互锁时机器人误判跟踪结束导致偏移量被清零。激活后把“使能跟踪”置为 TRUE保存重启一次控制器。重启后到设备状态页确认 Group 1 状态为 RUN。有的系统版本里这里还会要求你指定跟踪周期默认是 8 ms。传送带速度超过 2 m/s 时可以考虑改到 4 ms但不要随意调短改得太短会占用控制器扫描时间反而让运动指令出现断续。组编号一旦确定整个项目里尽量不要改变。因为机器人程序、后台逻辑和视觉程序里都会引用组号切换组编号意味着你要把所有引用一起改掉。尤其是项目后期改组号很容易漏掉某个没注意的位置。用 Group 1 还是 Group 2设计阶段就要定清楚。3.2 关键参数表方向、减速比、每脉冲位移跟踪组参数很多大部分保持默认真正影响抓件位置的就几个。方向决定编码器正转时传送带往哪边运动填反了机器人会往反方向追。减速比是编码器轴转数与驱动轮轴转数之比如果编码器直接装在从动轮上减速比填 1。每脉冲位移直接决定跟踪距离的标尺必须准确。下表是现场最常修改的一组FANUC 参数名中文叫法常见设置调错的现象DIRECTION跟踪方向FORWARD / REVERSE机器人反向追越追越远RATIO减速比30.0位移累计偏小或偏大PULSE/MM每脉冲位移0.0126抓偏且偏移随速度变大ENABLE DI使能输入DI[101]不使能跟踪不启动ACCURACY跟踪精度1 mm精度越低路径越抖实际调试时不要被“精度”这个词骗了。它允许你降低跟踪计算负载代价是运动路径会出现阶梯感。抓取应用一般填 1点焊这类需要轨迹稳定的应用填 0.5 或 0.1。精度不是越高越好过高会让机器人不断修正轨迹甚至会触发伺服超速报警。参数填完后最好把当前组导出一份备份。FANUC 支持把系统参数输出到存储卡导出的文件里包含跟踪组配置。做设备更换或控制器版本升级时这份备份可以在几分钟内恢复所有跟踪设置不用重新标定。3.3 通过 TP 程序读回并校验已生效的跟踪参数参数填完之后每次启动前最好用程序把关键值读回来对比一遍防止有人误改。FANUC 的 TP 语言可以直接把系统变量读入寄存器。下面是一段用简化变量名写的示例123: ! 读取跟踪组1的每脉冲位移到 R[10] 124: R[10] $TRKGRP[1].$PULSE_MM 125: ! 读取方向符到 R[11] 126: R[11] $TRKGRP[1].$DIRTYPE[0] 127: IF R[10] 0.01 THEN 128: DOUT[201]ON ! 报警输出 129: ENDIF这段 TP 代码的逻辑是先把每脉冲位移和方向符从跟踪组变量取出来存入常规寄存器。接着判断每脉冲位移是否小于 0.01如果是说明参数没填或已被清空这时点亮一个 DO 输出提醒现场。方向符在不同控制器版本里定义不同有的是整数 0/1有的是布尔量。具体变量名以你手上的 LINE-TRACKIN 中文资料为准代码里的命名只是示意。读取权限上$TRKGRP有些系统限制为维护模式才能访问。普通操作员账户会报权限不足。这种情况先登录 MANAGE 账户再运行程序不要在维修账户里硬改变量。如果程序里读出来的值和示教器菜单显示不一致以刚重启后的状态为准因为运行中的跟踪组数据每时每刻都在变化。4. 写一段能“追件”的跟踪程序触发、等待与补偿配置好跟踪组剩下的就是程序逻辑。跟踪程序不外乎三种结构先到等待位置然后触发启动追到抓取点最后退出。这里的关键不是移动指令本身而是时序。启动太早工件还没进入编码器有效区启动太晚机器人加速度不够追不上。4.1 选择触发源DI、视觉或启动脉冲最可靠的触发源是光电传感器。当检测到工件挡住光眼时DI 从 OFF 变 ON代表可以开始累计位移。如果工件形状复杂光电会误触发可以考虑改用视觉定位让视觉在工件到达拍照区时输出一个启动信号。使用启动脉冲的场合比较少见一般是编码器 Z 相每圈输出一个同步点适合周期很短的托盘线。无论选哪一种触发信号必须经过防抖处理。机器人扫描周期内信号抖动会让跟踪组清零产生不该有的偏移。做法是在 PLC 中做 ON 延时或者用机器人后台逻辑做 10 ms 延时确认。不要把这个逻辑放在主程序里因为主程序还要执行运动指令时间不一定可控。如果使用视觉作为触发源还要考虑视觉处理时间。比如相机从拍照到输出坐标需要 120 ms在这期间传送带已经走了 20 mm。这个量可以在视觉数据计算目标点时直接补偿也可以等工件到跟踪起点后再启动跟踪。常见做法是后者因为它不影响已经建立的跟踪组计数。4.2 跟踪程序骨架启动跟踪到离开跟踪区下面是一段常见的最小跟踪程序骨架用 TP 语言写。它假设 DI[101] 为工件到位信号DO[102] 为夹爪P[10] 是跟踪开始点P[11] 是抓取点。10: ! 等待工件到位信号 ON 11: WAIT DI[101]ON 12: ! 启动跟踪组 1 13: SET $TRKGRP[1].$STARTTRUE 14: ! 等待跟踪启动完成 15: WAIT $TRKGRP[1].$RUN_STTRUE 16: ! 运动到跟踪开始点 17: L P[10] 500mm/s CNT100 18: ! 跟踪过程中移动到抓取点 19: L P[11] 700mm/s CNT50 20: DO[102]ON ! 夹爪闭合 21: ! 退出跟踪 22: SET $TRKGRP[1].$STARTFALSE 23: L P[12] 700mm/s CNT100这段代码的顺序很关键。第 11 行必须先等到到位信号第 13 行才启动跟踪。第 15 行确认系统已经进入跟踪状态避免在第 17 行运动指令执行时跟踪还未就绪。第 17 和 19 行使用普通运动指令即可不需要写编码器数值机器人控制器会自动把跟踪组累计的位移叠加进目标点。第 22 行关断跟踪后机器人才离开传送带否则离开时带着偏移容易撞到护栏。注意第 19 行到达抓取点时机器人本身和传送带之间仍然保持相对静止。夹爪闭合后要立刻决定下一个动作如果只是抓取可以直接抬升退出如果还要放料那就保持跟踪直到放料完成再关断。最忌讳的是夹爪还没闭合就关断跟踪机器人会因为突然失去补偿而停在错误位置。4.3 速度、加速度与跟踪时间窗口的匹配跟踪时机器人允许的最大速度取决于传送带速度、跟踪区长度和机器人加减速能力。粗算的经验公式不太直观实际中更常用的是按传送带速度的 3 倍设定机器人速度再在抓取点观察偏差。如果偏差随节拍增大说明速度余量不够。跟踪时间窗口指的是从触发点到离开点的总时间。这个窗口小于机器人完成加减速的时间时就要提前在固定位置开始跟踪而不是到了工件旁边才启动。反过来说跟踪区设得太长编码器累计误差也会变大一般不建议超过 2 米。实际项目中我会在传送带上做两个挡块来限定跟踪区域这样窗口大小是固定的程序参数也更容易标定。还要留神负载变化对加速度的影响。空爪和抓满工件后机器人的实际加减速度可能差 20% 以上。如果程序里用了相同的加速度设定值重负载下会出现明显滞后。在前后端加入“负载检测”或直接修正速度百分比是保持长时间稳定跟踪的关键。5. 调试跟踪偏差报警排除与“试走—测量—修正”跟踪调试最多的是两种抱怨不动作或者动作了但抓偏。不动作先查 DI 信号是否进入控制器以及跟踪组是否在 RUN。抓偏则进入下面的系统化修正流程不要上来就改程序。5.1 先分清 SYS-212 这类 DCS 报警和跟踪报警现场常把 SYS-212 报警和线跟踪混在一起排查。SYS-212 其实是 DCSDual Check Safety参数缺失或速度校验不通过不是线跟踪本体的问题。出现 SYS-212 时先到 DCS 菜单确认安全速度、安全距离是否按应用填写否则跟踪功能会一直被锁定。跟踪本身特有的报警大多带“TRK”关键字比如跟踪组未启动、编码器断线。两类报警处理逻辑完全不同看到 SYS-212 先放下跟踪参数把 DCS 通道解掉再回头看跟踪。5.2 用示教器观察跟踪偏移量进入示教器的跟踪状态页面能看到每组当前累计位移和机器人随动偏移量。让传送带低速运行一个工件在跟踪开始点和抓取点分别记下偏移量。两个点的偏移差如果恒定说明编码器标定有误差如果随速度增大说明动态响应跟不上。把两次记录写到寄存器里连续跑十个工件做曲线判断是周期性误差还是漂移再决定调标定还是调速度。5.3 一个实用的零位标定技巧一个非常实用的零位标定在传送带静止时把机器人抓取点示教在工件中心然后把跟踪组累计位移清零。接着手动推传送带走一段固定距离比如 200 mm再用示教器看跟踪组显示的位移是不是 200 mm。误差超过 2 mm 就回头重新算每脉冲位移。如果显示值比实测值稳定地小多半是减速比填大了稳定地大那就往反方向调整。这个验证只花五分钟却能排除掉一半的抓偏问题。本文还有配套的精品资源点击获取
