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信号进行简单触发和结果反馈。前者适合传递坐标、角度等连续数据,后者适合传递“有工件/无工件”“允许抓取/禁止抓取”等开关量。
示教器:配置、标定与现场调试的入口
示教器是操作人员与机器人交互的直接工具。在视觉抓取项目中,示教器主要承担四类工作:第一,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配置参数,实际项目中应根据控制柜型号、视觉软件和夹爪类型调整:
| 配置项 | 示例值 | 作用 |
|---|---|---|
| 通信协议 | 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测试确认每个信号,再用示教器单步运行抓取程序,最后才切换到自动模式。这样可以把通信问题、坐标问题和机械问题分开定位,避免多个故障叠加导致排查困难。