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


第一次写的不咋样,请理解!

ABB机器人设置安全区(案例版)的更多相关文章

  1. Learning ROS for Robotics Programming - Second Edition(《ROS机器人编程学习-第二版》)

    Learning ROS for Robotics Programming - Second Edition <ROS机器人编程学习-第二版> ----Your one-stop guid ...

  2. ABB机器人添加串口模块后无法使用的解决办法

    [环境] ABB机器人1520,IRC5,RobotWare5.6,Win10 64bits,RobotStudio6.0 [过程和表现] 由于项目需要和机器人通信,DeviceNet又不能满足要求, ...

  3. ROS(indigo)ABB机器人MoveIt例子

    ROS(indigo)ABB机器人例子 参考网址: 1  http://wiki.ros.org/Industrial 2  http://wiki.ros.org/abb 3  https://gi ...

  4. 阿里云云主机swap功能设置实战案例

    阿里云云主机swap功能设置实战案例 阿里云提供的云服务器(Elastic Compute Service,简称 ECS),是云主机的一种,当前采用的虚拟化驱动是Xen(这一点可以通过bios ven ...

  5. ABB机器人基础培训资料整理与总结

    之前对机械臂了解较少,这方面知识比较匮乏.只使用过PowercCube六自由度机械臂. 感谢ABB公司何老师的耐心指导. 学习资料汇总:(最重要的ABB Robot 官网就不列出了,这里以中文资料为主 ...

  6. ABB机器人故障处理指南

    ABB工业机器人常见故障处理 1. 开机示教器显示如下   1) 如果机器人开机,示教器一直显示connecting to the robot controller,如上图(robotware版本是白 ...

  7. 图灵机器人API调用 C++版

    这是一个非常简单的例子,作为新手的我是拿来练手的,当然也可以给和我一样的朋友一些参考. 而且图灵官网没有给出C的例子,网上一搜也是各种Java.C#甚至易语言实现,不要歧视C++好不好●︿●,就算不如 ...

  8. 用ajax写机器人聊天的案例

    HTML 中的文档 <body> <h3>简单的Ajax实例</h3> <div class="chatbox"> <!-- ...

  9. SkiaSharp 之 WPF 自绘 拖曳小球(案例版)

    感谢各位大佬和粉丝的厚爱和关心( 催更),我会再接再厉的,其实这也是督促自己的一种方式,非常感谢. 刚写了一篇万字长文,自己也休养生息(低调发育)了一段时间,接下来来几个小案例. 拖曳小球 WPF的拖 ...

随机推荐

  1. [python,2018-06-29] 37%法则及其拓展解决恋爱问题

    37%法则 苏格拉底的问题: 在一片麦田里摘出一颗最大最好的麦穗.但只能摘一次,而且不能回头. 传说这是苏格拉底给他的弟子柏拉图提出的问题,又传说柏拉图进行了2次选择: 1.柏拉图第一次走进麦田,他发 ...

  2. Tmux 常用快捷键

    Ctrl-b : Send the prefix key through to the application. " : Split the current pane into two, t ...

  3. mysql中的int和tinyint、varchar和char、DateTime和TimeStamp区别

    一.int和tinyint的区别 大小: tinyint在mysql中占用1个字节 即: 1 bytes = 8 bit ,一个字节最多可以代表的数据长度是2的8次方:11111111 = 256 在 ...

  4. Javascript FormData实例

    一.创建一个formData对象实例的方式 1.创建一个空对象 var formData = new FormData();//通过append方法添加数据 1 2.使用已有表单来初始化对象 //表单 ...

  5. 团队作业-Week9-软件项目的风险

    一.软件项目中的风险 软件项目的风险无非体现在以下四个方面:需求.技术.成本和进度.IT项目开发中常见的风险有如下几类: (1)需求风险 ①需求已经成为项目基准,但需求还在继续变化: ②需求定义欠佳, ...

  6. python 反射 hasattr getattr

    class BlackMedium:     feature='Ugly'     def __init__(self,name,addr):         self.name=name       ...

  7. MYSQL1

    一:对查询就行优化 避免全表查询 1.首先考虑在where及order by 列上建立索引 2.where子句   LIKE  '%abc%' 前置%   引擎放弃使用索引而进行全表扫描 3.wher ...

  8. Django url

    urlpatterns = [ url(正则表达式, views视图函数,参数,别名),]     参数说明:   一个正则表达式字符串 一个可调用对象,通常为一个视图函数或一个指定视图函数路径的字符 ...

  9. pymysql -转自https://www.cnblogs.com/chenhaiming/p/9883349.html#undefined

    PyMysql的几个重要方法 connect函数:连接数据库,根据连接的数据库类型不同,该函数的参数也不相同.connect函数返回Connection对象. cursor方法:获取操作数据库的Cur ...

  10. 学生月上网时间分布-TestData

    Python机器学习应用 | [第一周]无监督学习 - weixin_42906066的博客 - CSDN博客https://blog.csdn.net/weixin_42906066/article ...