2. FANUC机器人硬件与控制系统基础

在视觉引导抓取系统中,机器人本体、控制柜、示教器、通信接口与I/O配置共同构成一个完整的执行与信息闭环。视觉系统负责“看”,而FANUC机器人硬件与控制系统负责“动”和“判断何时动”。如果只关注相机标定和视觉算法,却忽略控制柜的通信能力、I/O分配和示教器中的参数设置,抓取任务往往会在“最后一米”失败。本节从抓取任务的实际需求出发,说明各硬件组成部分的作用、连接关系以及关键配置方法。

机器人本体:抓取动作的物理执行者

FANUC机器人本体通常由基座、J1至J6六个关节轴、臂部、腕部和末端法兰组成。在视觉抓取任务中,本体需要完成的核心动作是:从视觉系统获得目标位姿后,运动到抓取准备点,再以受控姿态接近目标,闭合夹爪,最后将工件放置到指定位置。以常见的M-10iD/12为例,其额定负载为12 kg,最大工作半径约1441 mm,重复定位精度约±0.02 mm。这些参数直接决定抓取节拍和可抓取范围:如果夹爪加工件总重超过12 kg,或目标位置超出工作半径,视觉识别再准确也无法完成抓取。

末端法兰是视觉抓取中需要特别关注的机械接口。夹爪、吸盘或专用手爪通过法兰安装,法兰上的定位销孔和螺栓孔决定工具中心点(TCP)的初始位置。实际工程中,通常先安装夹爪,再通过示教器四点法或六点法标定TCP。TCP标定不准确,视觉给出的目标坐标就会整体偏移,表现为“相机看到了,但机器人抓偏”。

控制柜:运动控制与通信中枢

控制柜是FANUC机器人的“大脑和神经中枢”,内部包含主控单元、伺服驱动器、电源模块、I/O板卡和通信接口。对于视觉抓取,控制柜最关键的能力是:接收视觉系统发送的目标位姿数据,将其转换为机器人可执行的运动指令,并协调夹爪、气缸、传感器等外围设备动作。

以R-30iB Plus控制柜为例,其标准配置通常包括以太网接口、DeviceNet或Profinet接口、数字I/O和模拟I/O。视觉系统与机器人的通信方式主要有两类:一类是通过以太网直接通信,视觉系统将目标坐标以字符串或结构体形式发送给机器人;另一类是通过I/O信号进行简单触发和结果反馈。前者适合传递坐标、角度等连续数据,后者适合传递“有工件/无工件”“允许抓取/禁止抓取”等开关量。

FANUC视觉抓取硬件与信号连接关系 视觉系统 相机 / 视觉控制器 输出:X,Y,Z,Rx,Ry,Rz 示例:X=452.3mm Y=-118.7mm R-30iB Plus 控制柜 主控单元 伺服驱动器 I/O板卡 以太网接口 示教器 TCP标定 / 程序示教 I/O手动测试 状态监控与报警查看 机器人本体 M-10iD/12 J1~J6 六轴关节 · 负载12kg · 臂展1441mm 末端法兰 夹爪/吸盘 外围执行与检测 夹爪电磁阀 工件到位传感器 安全门/急停回路 以太网 坐标数据 伺服指令 DO/DI 示教/监控 关键信号流:视觉系统 → 以太网 → 控制柜解析坐标 → 运动指令 → 机器人本体 → 夹爪动作 关键I/O:DO[1]夹爪闭合 · DO[2]夹爪张开 · DI[1]工件到位 · DI[2]夹爪确认

示教器:配置、标定与现场调试的入口

示教器是操作人员与机器人交互的直接工具。在视觉抓取项目中,示教器主要承担四类工作:第一,TCP标定,通过四点法或六点法确定夹爪中心相对于法兰的位置;第二,用户坐标系标定,确定工件或料框相对于机器人基坐标的位置;第三,I/O手动测试,在自动运行前逐个确认夹爪、传感器和安全信号是否正常;第四,程序示教与单步调试,观察机器人从抓取准备点到放置点的完整轨迹。

实际调试中,一个常见问题是视觉坐标与机器人坐标不一致。此时不应直接修改视觉程序,而应先在示教器中检查用户坐标系编号是否与视觉系统约定的一致。例如视觉系统输出的是相对于UFRAME[3]的坐标,而机器人在UFRAME[1]下运动,抓取位置就会整体偏移。正确做法是:在示教器中进入“SETUP → Frames → User Frame”,确认UFRAME[3]的原点和方向,并在视觉通信程序中明确指定使用该坐标系。

通信接口与I/O配置:视觉与机器人的“语言”

视觉系统与FANUC机器人之间的通信,通常采用以太网Socket通信或现场总线通信。以太网通信的典型配置是:机器人作为客户端或服务器,视觉系统作为另一端,通过TCP/IP协议交换字符串。例如视觉系统发送“452.3,-118.7,205.6,0,0,0”,机器人端使用ROBOGUIDE或KAREL程序解析该字符串,并赋值给位置寄存器PR[10]。随后机器人执行“J P[1] 100% FINE”到准备点,再以“L PR[10] 200mm/sec FINE”直线运动到抓取点。

I/O配置则负责开关量交互。以数字输出DO和数字输入DI为例,常见分配如下:DO[1]控制夹爪闭合,DO[2]控制夹爪张开,DO[3]请求视觉拍照,DI[1]表示工件到位,DI[2]表示夹爪已闭合到位,DI[3]表示视觉拍照完成。机器人程序在抓取前先置位DO[3],等待DI[3]为ON,再读取视觉坐标;抓取时置位DO[1],等待DI[2]为ON,确认夹爪已夹紧后再抬起。这种“请求—等待—确认”的I/O握手逻辑,是避免撞机和掉件的关键。

示教器中的I/O手动测试功能可以强制输出DO信号,用于检查电磁阀和夹爪动作。测试前应确认机器人处于安全速度或已暂停,避免夹爪在错误位置闭合造成碰撞。

抓取任务中的参数配置示例

以下是一组用于教学示例的通信与I/O配置参数,实际项目中应根据控制柜型号、视觉软件和夹爪类型调整:

配置项 示例值 作用
通信协议 TCP/IP Socket 传输目标坐标字符串
机器人端口 6000 视觉系统连接目标端口
坐标格式 X,Y,Z,Rx,Ry,Rz 单位mm和度,逗号分隔
用户坐标系 UFRAME[3] 与视觉系统约定一致
工具坐标系 UTOOL[2] 夹爪TCP标定结果
DO[1] 夹爪闭合 抓取时置ON
DO[2] 夹爪张开 放置时置ON
DI[1] 工件到位 视觉拍照触发条件
DI[2] 夹爪确认 夹紧到位反馈

从硬件到抓取:一个完整的信号闭环

把上述部件串起来看,一次视觉抓取任务的信号闭环如下:工件到位后DI[1]为ON,机器人置位DO[3]请求拍照;视觉系统拍照并计算目标位姿,通过以太网发送坐标字符串;控制柜解析坐标并写入PR[10];机器人从准备点直线运动到PR[10]对应的抓取点;到达后置位DO[1]闭合夹爪;DI[2]确认夹紧后,机器人抬起并运动到放置点;置位DO[2]张开夹爪,完成放置。整个过程中,示教器用于标定TCP和用户坐标系、测试I/O、监控程序运行状态;控制柜负责通信解析和运动控制;机器人本体执行实际动作;夹爪和传感器完成抓取与反馈。

理解这套硬件与控制系统的分工,是后续学习视觉标定、坐标变换和抓取程序编写的基础。实际调试时,建议先用手动I/O测试确认每个信号,再用示教器单步运行抓取程序,最后才切换到自动模式。这样可以把通信问题、坐标问题和机械问题分开定位,避免多个故障叠加导致排查困难。