ABB机器人设置安全区、中断（案例版）
1.概述
在如今机器人中普遍会设置机器人的安全区域，也可以理解为工作范围。主要目的是为了机器人运行时的安全性和可靠性。ABB机器人也不例外，下面我们就讲讲ABB机器人安全区域的设定。
2.设置安全区基本知识
第一步：定义该全局变量的类型：长方体(WZBoxDef)、圆柱(WZCylDef)、球形(WZSphDef)
第二步：定义启动全局区域：带输出(WZDOSet)、启动临时全局区域(WZEnable)
第三步：停用临时全局区域监控(WZDisable)、擦除临时全局区域监控(WZFree)
注意事项：1.在电动机开启的状态下，固定全局区域始终有效，且仅通过重启来擦除。不可能通过RAPID指令来禁用、启用或擦除固定全局区域
2.一旦定义和启用，临时的全局区域可通过WZDisable禁用，通过WZEnable再次启用以及通过WZFree擦除。自动擦除运动任务中的所有临时全局区域，并将运动任务中的所有wztemporary类数据对象设置为0。
3.ABB机器人实际案例1
3.1.案例概述：
安全区：“绘制”一个临时全局有安全区域，当TCP运行到安全区内，将信号（D652_DO01_Pick）置为，如果在安全区外信号自动复位。
中断：当机器人接受到信号为1时产生中断，机器人停止运行并且回到Home点等待。当信号为0时，机器人回到原工作点，启动机械臂继续运行
1 MODULE ZCheShiMouKuai //模块名称
2 //定义一个中断获取点目标点（辅助作用）
3 var robtarget PZhongDuang:=[[16.33,205.77,4.47],[0.00422709,0.709453,-0.704723,0.00484291],[-1,-1,0,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
4 //定义一个安全区中心点
5 var robtarget C1_AQD:=[[409.82,-38.93,234.96],[0.015194,0.0221478,-0.999442,0.0198559],[0,0,1,0],[9E+09,9E+09,9E+09,9E+09,9E+09,9E+09]];
6 //定义一个中断识别号
7 VAR intnum intno1;
8 //定义一个临时全局变量
9 VAR wztemporary roll;
10 //全局区域形状数据
11 VAR shapedata volume;
12 //本次用到安全去形状为圆柱，C1圆心、R1半径、H1高度
13 VAR pos C1:=[0,0,0];
14 CONST num R1:=100;
15 CONST num H1:=200;、
16
17 PROC Init_ZD() //中断初始化
18 IDelete intno1; //取消中断
19
20 //将中断与软中断程序相连
21 CONNECT intno1 WITH TingZhi;
22 //将中断与信号相连接，当DI00置1时产生中断
23 ISignalDI DN_DI00_Place , 1 , intno1;
24 //启用中断，系统默认启动
25 IWatch intno1;
26 ENDPROC
27
28 PROC Init_AnQQ() //安全区初始化
29 //获取C1_AQD目标点的X、Y、Z进行赋值，相当于该目标点为原点
30 C1.x := C1_AQD.trans.x;
31 C1.y := C1_AQD.trans.y;
32 C1.z := C1_AQD.trans.z;
33 //定义圆柱形全局区域
34 WZCylDef \Inside , volume , C1 , R1 , H1;
35
36 //启用全局区域，设置数字信号输出
37 //Temp:临时全局区域 临时区域变量名称为roll
38 //Inside:在圆柱区内，触发信号。
39 WZDOSet \Temp , roll , \Inside , volume , D652_DO01_Pick , 1; //注意：开机后不可运行第二次
40 ENDPROC
41
42 PROC main_3()
43 Init_ZD;
44 Init_AnQQ;
45 WHILE TRUE DO
46 MoveJ Offs(C1_AQD,0,0,0), v1000, z50, tool1;
47 MoveL Offs(C1_AQD,100,0,50), v1000, z50, tool1;
48 MoveL Offs(C1_AQD,-100,30,30), v1000, z50, tool1;
49 MoveL Offs(C1_AQD,10,150,100), v1000, z50, tool1;
50 MoveL Offs(C1_AQD,30,-150,200), v1000, z50, tool1;
51 MoveL Offs(C1_AQD,60,0,30), v1000, z50, tool1;
52 MoveL Offs(C1_AQD,-130,50,0), v1000, z50, tool1;
53 ENDWHILE
54 WZFree roll; //擦除临时全局区域监控
55 ENDPROC
56
57 TRAP TingZhi //中断程序
58 StopMove\Quick; //停止机械臂的移动
59 StorePath; //发生中断时，存储路径
60 PZhongDuang := CRobT(\Tool:=tool1,\WObj:=wobj0);
61 HOME_r; //回Home点
62 TPErase;
63 TPWrite "Abort, return to Home and stop running";
64 WaitDI DN_DI00_beishuliandaowei , 0; //当信号为0时继续运行
65 Movel PZhongDuang, v300, fine, tool1\WObj:=wobj0;
66 RestoPath; //中断之后，恢复路径
67 StartMove; //启动机械臂的移动
68 TPWrite "The signal is off and running";
69 ENDTRAP
70
71 PROC HOME_r()
72 rob_home_PP:=CRobT(\Tool:=tool1,\WObj:=wobj0);
73 rob_Home_PP.trans.z:=Rob_Home.trans.z;
74 Movel Offs(Rob_Home_PP,0,0,0), v300, fine, tool1\WObj:=wobj0;
75 MoveJ Offs(Rob_Home,0,0,0), v1000, fine, tool1\WObj:=wobj0;
76 ENDPROC
77 ENDMODULE
第一次写的不咋样，请理解！
