3. 工业机器人基础与TRUMPF适配

在激光加工自动化集成中,六轴工业机器人承担着把激光加工头精确送到空间任意位姿的任务。理解机器人运动学、主流品牌编程方式以及机器人与TRUMPF激光设备之间的机械与电气接口,是完成系统集成的前提。本节围绕这三条主线展开,重点说明“怎么算、怎么写、怎么接”。

一、六轴机器人运动学:从关节到TCP

六轴机器人由底座、肩、肘、腕组成,六个旋转关节串联成开链结构。每个关节的转角记为 θ₁~θ₆,机器人控制器通过正运动学把关节角映射为法兰盘在基坐标系下的位姿(位置 x、y、z 与姿态 A、B、C 或四元数)。实际加工中我们关心的不是法兰,而是安装在法兰上的激光加工头焦点位置,即工具中心点 TCP。TCP 由工具坐标系(Tool Frame)定义:相对法兰的偏移量 (X, Y, Z) 与姿态 (RX, RY, RZ)。例如某激光头法兰到焦点沿 Z 方向偏移 285 mm,则工具坐标 Z 设为 285 mm,控制器在示教时即以焦点为参考点。

逆运动学则相反:给定目标位姿,求解各关节角。六轴机器人通常存在多组解(肩前/肩后、肘上/肘下、腕翻转),控制器依据关节限位、奇异点距离和路径连续性选择最优解。集成中必须关注两类问题:一是奇异点,当腕关节轴线共线时,微小位姿变化会引起关节速度剧增,激光加工中表现为轨迹抖动或停顿;二是关节限位,激光头体积较大,某些姿态下会与工件或夹具干涉。因此在离线编程阶段就应检查可达性与姿态余量。

二、ABB / KUKA / FANUC 编程基础对比

三大品牌在编程语法、坐标系约定和运动指令上各有特点,但核心逻辑一致:定义工具与工件坐标系,编写运动指令,控制开关量输出激光使能。

项目ABB (RAPID)KUKA (KRL)FANUC (TP/KAREL)
运动指令MoveL / MoveJ / MoveCLIN / PTP / CIRCL / J / C
工具坐标tooldataTOOL_DATAUTOOL_NUM
工件坐标wobjdataBASE_DATAUFRAME_NUM
数字输出SetDO$OUT[x]=TRUEDO[x]=ON
等待信号WaitDIWAIT FORWAIT DI[x]=ON

以“机器人移动到焊接起点并开启激光”为例,ABB 写法为:

MoveJ pHome, v1000, z50, tool0;
MoveL pStart, v200, fine, tLaserHead;
SetDO doLaserOn, 1;
WaitDI diLaserReady, 1;
MoveL pEnd, v50, fine, tLaserHead;
SetDO doLaserOn, 0;

KUKA 对应写法为 PTP HOME、LIN P_START、$OUT[1]=TRUE、WAIT FOR $IN[1]。FANUC 则用示教器记录 J P[1] 100% FINE、L P[2] 200mm/sec FINE、DO[1]=ON、WAIT DI[1]=ON。集成时需注意:不同品牌对速度单位、到位精度(fine/CNT、FINE/COARSE)的定义不同,激光加工通常要求轨迹连续且速度稳定,因此直线段多采用较高到位精度,避免拐角降速导致热输入不均。

三、TRUMPF激光设备与机器人法兰的机械接口

机械接口的核心是法兰盘与激光加工头的连接。主流六轴机器人法兰符合 ISO 9409-1 标准,常见规格为 A2(φ50 mm,4×M6)、A4(φ63 mm,6×M6)等。TRUMPF 激光头(如 BEO D70、PFO 系列)通常通过过渡法兰或快换盘安装。安装时必须保证:

  • 定位止口与法兰同心,径向跳动一般要求 ≤ 0.05 mm;
  • 连接螺钉按对角顺序分次拧紧,扭矩参考厂商规定(如 M6 约 10 N·m);
  • 激光头光轴与机器人法兰 Z 轴同轴,偏角误差控制在 0.1° 以内;
  • 线缆与气管预留足够弯曲半径,避免运动时拉扯。

若使用快换盘,还需校核其重复定位精度(通常 ±0.02 mm)和负载能力,确保激光头重量加线缆拖链的附加力矩在机器人腕部允许范围内。

四、电气接口与信号交互

电气接口分为供电、控制信号和安全回路三部分。TRUMPF 激光器通过 24 V DC 数字 I/O 或现场总线(PROFINET、EtherCAT)与机器人控制器通信。典型信号包括:激光使能(Laser On)、程序选择、功率设定、就绪反馈、故障报警。机器人侧通过数字输出触发激光,通过数字输入读取激光器状态,形成握手。

安全回路必须独立于普通 I/O:急停、光栅、门锁等信号接入安全 PLC 或安全继电器,直接切断激光使能。机器人运动使能与激光发射使能应互锁——只有机器人处于自动模式且轨迹运行中,激光才允许出光。

六轴机器人—TRUMPF激光设备接口关系图 六轴机器人 关节 J1–J6 控制器 / 示教器 数字 I/O · 总线 法兰盘 ISO 9409-1 A2 / A4 TRUMPF 激光头 BEO D70 / PFO 聚焦镜 · 保护镜 TCP 焦点 TRUMPF 激光器 光纤输出 PROFINET 24V I/O 机械连接 光纤 电气信号交互(握手) 机器人 DO → 激光使能 激光 DI → 就绪反馈 功率设定 / 程序选择 故障报警 → 机器人 安全回路(独立于普通 I/O) 急停 · 光栅 · 门锁 → 安全 PLC → 切断激光使能与机器人运动使能

五、集成检查要点

完成机械与电气连接后,建议按以下顺序验证:先手动低速运行机器人,观察激光头与工件、夹具是否干涉;再标定 TCP,用尖点法或六点法确认焦点位置;然后测试 I/O 握手,确认激光使能、就绪、报警信号逻辑正确;最后在空运行模式下验证安全回路,确保急停能同时切断激光和机器人运动。只有以上环节全部通过,才可进入带激光的工艺试运行。

工具坐标系标定时,若激光头焦点不可直接接触标定针,可先用辅助尖棒代替,标定后再换算焦点偏移量,避免损坏光学镜片。