Professional Documents
Culture Documents
3 18机器人基础功能-防止干涉区域设置
3 18机器人基础功能-防止干涉区域设置
3 18机器人基础功能-防止干涉区域设置
FANUC 机器人
防止干涉区域设置指导手册
修订 姓名 日期
编制
审核
批准
版本 更新内容 日期 姓名
V1.0 首次发布
V1.1 格式更新 2022/2/7 崔华瑞
1 / 12
上海发那科机器人有限公司
目录
1、概述................................................................................................................................................................................ 3
2、设置步骤........................................................................................................................................................................ 3
2.1 坐标系设置............................................................................................................................................................ 3
2.2 进入防止干涉设置界面........................................................................................................................................3
2.3 干涉条件设置........................................................................................................................................................ 4
2.4 干涉区域设置....................................................................................................................................................... 5
3、程序示例........................................................................................................................................................................ 7
3.1 干涉区设置............................................................................................................................................................ 7
3.2 IO 信号设置............................................................................................................................................................8
3.3 TP 程序................................................................................................................................................................... 8
4、注意事项...................................................................................................................................................................... 10
4.1 干涉区设置注意项.............................................................................................................................................10
4.2 带行走轴机器人干涉区设置注意项.................................................................................................................11
5、附录.............................................................................................................................................................................. 12
2 / 12
上海发那科机器人有限公司
1、概述
防干涉区域功能是这样一种功能:当其它机器人或其它外围设备进入预先设定的干涉区域内时,即便向机器
人发出进入干涉区域的移动指令,机器人也会自动停止,直到确认其它设备已经从干涉区域移走后,解除停止状
态而自动重新开始动作。同时,可以设置对应 IO 输出,机器人实时判断 TCP 点位置,当 TCP 进入干涉区域时,
会将指定 DO 状态置为 OFF ,告知外围设备机器人已经进入干涉区域;当 TCP 离开干涉区域后,再将对应 DO
置 ON。
本文将介绍其配置过程,其主要步骤如下:
2、设置步骤
2.1 坐标系设置
1) 在设置干涉区之前,需要先设置并选中用户坐标系和工具坐标系,用于后续的干涉区域位置的指定。
2) 由于干涉区域形状为长方体,长宽高方向由用户坐标系指定,因此如果干涉区域方向与机器人世界坐标平行,
则使用默认世界坐标系即可,如下图 2.1;否则需要根据实际需要的干涉区域方向设置用户坐标系,如下图
2.2。工具坐标系一般根据实际使用的 TCP 点设置即可。
图 2.1 图 2.2
2.2 进入防止干涉设置界面
1) 点击菜单-设置-防止干涉区域,如下图 2.3,进入防止干涉区域列表界面,如下图 2.4。列表中可设置最多 10
个干涉区域。光标移动到想要设置的干涉区域行,点击 F4/F5 可将对应干涉区切换至“启用/禁用”状态,
3 / 12
上海发那科机器人有限公司
点击 F3[详细]可进入对应干涉区域设置界面。
图 2.3
图 2.4
2.3 干涉条件设置
1) 干涉区域详细设置界面如下图 2.5,各设置项详细说明如下图 2.6。
图 2.5
4 / 12
上海发那科机器人有限公司
图 2.6
2.4 干涉区域设置
1) 在干涉条件设置界面(图 2.5),点击 F2 [区域],进入干涉区域设置界面,如下图 2.7;干涉区域的指定有 2
种指定方式: 基准顶点+ 边长;或者基准顶点+ 对角顶点,可通过 F4 [选择]进行切换。如前文所述,设置
干涉区域时,需要先选中对应的用户坐标系跟工具坐标系,该界面显示的 XYZ 方向指的是下图 UFRAME 指
定的用户坐标系的方向,当记录基准顶点点位时,UFRAME 会自动设置为当前选中的用户坐标系编号。
图 2.7
基准顶点+ 边长(通常使用该方法)
SHIFT + F5[记录],将当前位置保存为基准顶点;之后微调各个方向位置时,可以将光标移动到对应数值上
直接输入。
可设置为负值。
5 / 12
上海发那科机器人有限公司
图 2.8
基准顶点+ 对角顶点
图 2.9
6 / 12
上海发那科机器人有限公司
3、程序示例
图 3.1
3.1 干涉区设置
干涉区的设置如下图 3.2,干涉区域范围如下图 3.3。
图 3.2
图 3.3
7 / 12
上海发那科机器人有限公司
3.2 IO 信号设置
IO 信号配置如下图 3.4(以 robot1 为例),robot1 的 DO101 对应 robot2 的 DI101,robot2 的 DO101 对
应 robot1 的 DI101,通过 PLC 中转。
图 3.4
3.3 TP 程序
后台程序:用于将干涉区的离开工作台 DO 与程序中的离开工作台 DO 进行处理,当两者都为 ON 时才
将出干涉区信号置 ON;2 台机器人都一样,如下图 3.5。
图 3.5
进干涉区程序:由于需要对 2 台机器人进行优先级处理,所以 2 台机器人会有所不同,下图 3.6 为 robot1
(优先进入),图 3.7 为 robot2,延时 0.3s 后再次判断 robot1 出干涉区是否为 ON,如果已经 OFF,说明在
这 0.3s 内,robot1 已经进入了干涉区,那么 robot2 需要将 DO[92]重新置 ON,等待 robot1 优先作业。如果
0.3s 后 DI[101]还是为 ON,那 robot2 跳转到程序 LBL[20],可以进入工作台作业。
8 / 12
上海发那科机器人有限公司
图 3.6
图 3.7
出干涉区程序:只需将对应 DO 置 ON,2 台机器人一样,如下图 3.8。
9 / 12
上海发那科机器人有限公司
图 3.8
4、注意事项
4.1 干涉区设置注意项
当干涉区 DI 信号为 OFF 时,机器人从干涉区外往干涉区里运动时,会在 TCP 进入干涉区域边缘时减速停止,
实际停止位置会进入到干涉区内,根据运行速度不同停止位会有所不同,因此设置干涉区域时应比实际需要
稍大一些。
干涉区域记录完成后,干涉区的位置即被固定下来,切换用户坐标系或者修改对应用户坐标系的值均不会影
响干涉区域的位置。(除非重新记录顶点位置,才会刷新用户坐标系的值。)
机器人仅判断 TCP 点是否进入干涉区,因此,在需要切换工具坐标系的应用时需要特别注意。如下图 4.1,
在允许进入干涉区 DI 为 OFF 时,将 TCP 点设置为工具前端时,工具不会进入干涉区内。如果将 TCP 切换
到机器人法兰盘中心点,如下图 4.2,则前端工具会进入干涉区域(此时 TCP 仍在干涉区外)。
图 4.1 图 4.2
10 / 12
上海发那科机器人有限公司
4.2 带行走轴机器人干涉区设置注意项
当机器人配在直线导轨上时,设置防干涉区域应注意所配置的导轨是内部轴(Integrated)还是直线导
轨是外部轴(auxiliary),两者有所区别。
直线导轨配置为内部轴(Integrated)时,干涉区域位置是固定的,如下图 4.3。
图 4.3
直线导轨配置为外部轴(auxiliary)时,干涉区域是跟着机器人随着导轨一起移动的,如下图 4.4。
图 4.4
11 / 12
上海发那科机器人有限公司
5、附录
12 / 12