ABB机器人安全区World Zone(详解) |
您所在的位置:网站首页 › abb机器人指令介绍 › ABB机器人安全区World Zone(详解) |
定义箱体外部的体积(反体积)。 必须指定Inside和Outside两个项目中的一个。 Shape: 数据类型:shapedata 定义的体积的存储的变量(系统的私有(private)数据)。 LowPoint: 数据类型:pos 定义箱体的一个较低的角点的位置(x, y, z)以毫米为单位。 HighPoint: 数据类型:pos 定义箱体的另一个相对的角点的位置(x, y, z)以毫米为单位。 程序执行: 箱体的定义存储在shapedata类型(Shape项目)的变量中,用于将来在WZLimSup和WZDOSet指令中使用。 限制: LowPoint和HighPoint的位置必须是有效的相对角点(x,y和z的坐标值都不相同)。如果用机器人来指出LowPoint和HighPoint,工作对象(wobj0)必须激活(在robtarget中使用trans组件,即p1.trans作为项目)。 语法: WZBoxDef [[‘’Inside] | [‘’Outside]’,’ [LowPoint’:=’]’,’ [Shape’:=’]’,’ [HighPoint’:=’]’;’ 2.WZCylDef—定义一个圆柱形的World Zone 用途: WZCylDef(World Zone圆柱定义)用来定义一个圆柱形状的World Zone,该圆柱的轴线平行于World坐标系的z轴。 基本范例: 该指令的基本范例说明如下: 例1 VAR shapedata volume; CONST pos C2:= [300, 200, 200]; CONST num R2:= 100; CONST num H2:=200; … WZCylDef Inside, volume, C2, R2, H2; 定义一个圆柱,底面圆心为C2,半径R2,高度H2。 项目: WZCylDef [Inside] | [Outside] Shape CenterPoint Radius Height [Inside]: 数据类型:switch 定义圆柱内部的体积。 [Outside]: 数据类型:switch 定义圆柱外部的体积(反体积)。 必须指定两个项目Inside和Outside中的一个。 Shape: 数据类型:shapedata 用来存储定义的体积的变量(系统的私有(private)数据)。 CentrePoint: 数据类型:pos 定义圆柱的一个底面圆的圆心位置(x,y,z),单位是毫米。 Radius:(半径) 数据类型:num 圆柱的半径,单位是毫米。 Height: 数据类型:num 圆柱的高度,单位是毫米。如果是正的(+z方向),CentrePoint项目是圆柱较低底面的圆心(如以上例子)。Height如果是负的(-z方向),CentrePoint项目是圆柱上底面的圆心。 程序执行: 圆柱的定义存储在shapedata类型的变量中(项目Shape),将来在WZLimSup或者WZDOSet指令中使用。 限制: 如果用机器人指出CentrePoint,工作对象wobj0必须被激活(使用robtarget中的trans组件,即p1.trans作为项目。 语法: WZCylDef [‘’Inside] | [‘’Outside]’,’ [Shape’:=’]’,’ [CentrePoint’:=’]’,’ [Radius’:=’]’,’ [Height’:=’]’;’ 1.1.WZDisable—解除临时World Zone监视 用途: WZDisable(解除World Zone)用来解除对临时World Zone的监视,该监视原先用来停止运动或者设置一个输出。 基本范例: 该指令的基本范例说明如下: 例1VAR wztemporary wzone; … PROC … WZLimSup Temp, wzone, volume; MoveL p_pick, v500, z40, tool1; WZDisable wzone; MoveL p_place, v200, z30, tool1; ENDPROC 当移动到p_pick的时候,机器人TCP的位置被检测到,这样机器人将不能够进入指定的体积wzone内部。当移动到p_place的时候,该监视没有执行。 项目: WZDisable WorldZone WorldZone: 数据类型:wztemporary Wztemporary类型的变量或者恒量,包含要解除的WorldZone的标识符。 程序执行: 临时WorldZone被解除。也就是说对机器人TCP在相应体积空间内的监视被临时停止。它可以通过WZEnable指令被再次激活。 限制: 只有临时WorldZone可以被解除。一个静态的WorldZone总是激活的。 语法: WZDisable [WorldZone’:=’]’;’ 1.2.WZDOSet—激活WorldZone来设置数字输出 用途: WZDOSet(WorldZone数字输出设置)用来定义动作并且激活一个WorldZone来监视机器人运动。 在该指令执行以后,当机器人的TCP或机器人/外部轴(关节中的区域)在定义的WorldZone内部或者接近WorldZone时,一个数字输出信号被设为一个特定的数值。 基本范例: 该指令的基本范例说明如下: 例1VAR wztemporary service; PROC zone_output( ) VAR shapedata volume; CONST pos p_service:= [500, 500, 700]; … WZSphDef Inside, volume, p_service, 50; WZDOSet Temp, service Inside, volume, do_service, 1; ENDPROC 在应用程序中定义临时WorldZone service,当机器人TCP在程序执行过程中或者点动过程中进入定义的球体时,设定信号do_service。 项目: WZDOSet [Temp] | [Stat] WorldZone [Inside] | [Before] Shape Signal SetValue [Temp]: 临时的 数据类型:switch 要定义的WorldZone是一个临时的WorldZone。 [Stat]: 静态的 数据类型:switch 要定义的WorldZone是一个静态的WorldZone。 必须指定[Temp]和[Stat]两个项目中的一个。 WorldZone: 数据类型:wztemporary或者wzstationary 可以根据WorldZone的特性(数字数值)进行更新的变量或者恒量。 如果使用可选项目Temp,数据类型必须是wztemporary。如果使用了Stat,数据类型必须是wzstationary。 [Inside]: 数据类型:switch 当机器人的TCP或者某一个轴进入定义的体积空间内的时候,将设定数字输出信号。 [Before]: 数据类型:switch 当机器人的TCP或者某一个轴进入定义的体积空间之前(马上就要进入空间),将设定数字输出信号。 两个项目[Inside]和[Before]必须选定一个。 Shape: 数据类型:shapedata 定义WorldZone空间的变量。 Signal: 数据类型:signaldo 将要改变的数字输出信号的名称。 如果使用了静态WorldZone,信号必须写保护,防止用户进入(RAPID,FP示教器)。在系统参数或者指定的轴上设定用户进入等级。 SetValue: 数据类型:dionum 当机器人TCP进入体积空间或者恰好在进入之前,期望的信号输出的数值(1或者0)。 在机器人TCP在外面或者正好在空间外面,信号输出为相反的数值。 程序执行: 定义的WorldZone被激活。从这时开始,机器人TCP位置(或者机器人/外部轴位置)将被监视,当机器人TCP位置(或者机器人/外部轴位置)在空间内(Inside)或者接近空间的边界(Before),将被设置输出。 如果和WZDOSet同时使用了WZHomeJointDef或者WZLimJointDef指令,只有在带空间监视的所有激活的轴即将进入或者已经进入关节空间时,才能够设置数字输出信号。 更多范例: 有关该指令如何使用的更多范例说明如下: 例1VAR wztemporary home; VAR wztemporary service; PERS wztemporary equip1:=[0]; PROC main( ) … ! 定义所有临时的WorldZone Zone_output; … ! equip1在机器人工作区域 WZEnable equip1; … ! equip1在机器人工作区域之外 WZDisable equip1; … ! 不再使用equip1 WZFree equip1; … ENDPROC PROC zone_output( ) VAR shapedata volume; CONST pos p_home:=[800, 0, 800]; CONST pos p_service:=[800, 800, 800]; CONST pos p_equip1:=[-800,-800, 0]; … WZSphDef Inside, volume, p_home, 50; WZDOSet Temp, home Inside, volume, do_home, 1; WZSphDef |Inside, volume, p_service, 50; WZDOSet Temp, service Inside, volume, do_service, 1; WZCylDef Inside, volume, p_equip1, 300, 1000; WZLimSup Temp, equip1, volume; ! equip1不在机器人工作区域。 WZDisable equip1; ENDPROC 在应用程序中定义临时WorldZone home和service, 当机器人在程序执行或者点动过程中分别进入球体home或者service时,这两个WorldZone用来设定信号do_home和do_service。 同时,定义一个临时WorldZone quip1,equip1只有在机器人程序中、当equip1在机器人工作区域以内的时候才会被激活。这时候,无论在程序执行或者手动的时候,机器人在进入equip1区域之前停止。通过使用恒量equip1的数值,equip1可以从其它程序任务中使能或者解除。 限制: WorldZone不能通过使用项目WorldZone中的相同的变量重复定义。 在RAPID程序中,静态的WorldZone不能被解除并再次激活,或者进行擦除。 在RAPID程序中,临时的WorldZone可以被解除(WZDisable),再次激活(WZEnable)或者擦除(WZFree)。 语法: WZDOSet [[‘’Temp] | [‘’Stat]’,’] [WorldZone’:=’] [‘’Inside] | [‘’Before] ‘,’ [Shape’:=’]’,’ [Signal’:=’]’,’ [SetValue’:=’]’;’ 1.3.WZEnable—激活临时WorldZone监视 用途: WZEnable(WorldZone使能)用来重新激活对临时WorldZone的监视,该WorldZone之前定义用来停止运动或者设定输出。 基本范例: 该指令的基本范例说明如下: 例1VAR wztemporary wzone; … PROC … WZLimSup Temp, wzone, volume; MoveL p_pick, v500, z40, tool1; WZDisable wzone; MoveL p_place, v200, z30, tool1; WZEnable wzone; MoveL p_home, v200, z30, tool1; ENDPROC 当往p_pick移动的时候,检测到机器人TCP的位置,这样它就不能进入特定的空间wzone。当进入p_place的时候没有进行这个监视,但是在移动到p_home的时候重新激活。 项目: WZEnable WorldZone WorldZone: 数据类型:wztemporary wztemporary类型的变量或者恒量,包含要激活的WorldZone的标识符。 程序执行: 临时WorldZone被再次激活。注意,当创建WorldZone的时候,它是自动激活的。如果被WZDisable指令解除后,它只是需要重新激活。 限制: 只有临时的WorldZone可以被解除或者再激活,静态的WorldZone总是激活的。 语法: WZEnable [WorldZone’:=’]’;’ 1.4.WZFree—擦除临时WorldZone监视 用途: WZFree(WorldZone释放)用来擦除临时WorldZone的定义,之前定义用来停止运动或者设定输出的。 基本范例: 该指令的基本范例说明如下: 例1VAR wztemporary wzone; … PROC … WZLimSup Temp, wzone, volume; MoveL p_pick, v500, z40, tool1; WZDisable wzone; MoveL p_Place, v200, z30, tool1; WZEnable wzone; MoveL p_home, v200, z30, tool1; WZFree wzone; ENDPROC 当往p_pick移动的时候,检测到机器人TCP的位置,所以它不能够进入指定的wzone空间。当往p_place移动的时候,该监视没有执行,但是在往p_home移动之前重新激活该监视。到达p_home之后,WorldZone的定义被擦除。 项目: WZFree WorldZone WorldZone: 数据类型:wztemporary wztemporary类型的变量或者恒量,包含要擦除的world zone的标识符。 程序执行: 临时world zone首先被解除,然后它的定义被擦除。一旦擦除,临时world zone不能被重新激活也不能被解除。 限制: 只有临时world zone可以被解除、重新激活或者擦除,静态world zone通常都是激活的。 语法: WZFree [WorldZone’:=’]’;’ 1.5.WZHomeJointDef—定义关节home位的WorldZone 用途: WZHomeJointDef(World Zone home关节定义)用来为机器人和外部轴在关节坐标中定义一个world zone,用来作为一个Home或者服务位置。 基本范例: 该指令的基本范例说明如下: 例1VAR wzstationary home; … PROC power_on( ) VAR shapedata joint_space; CONST jointtarget home_pos := [ [ 0, 0, 0, 0, 0, -45], [0, 9E9, 9E9, 9E9, 9E9, 9E9] ]; CONST jointtarget delta_pos := [ [2, 2, 2, 2, 2, 2], [5, 9E9, 9E9, 9E9, 9E9, 9E9] ]; … WZHomeJointDef Stat, home Inside, joint_space, do_home, 1; ENDPROC 定义并激活一个静态world zone home,当所有机器人轴和外部轴extax.eax_a在程序执行或者点动过程中处于关节位置home_pos(每一个轴在+/-delta_pos范围内),home把信号do_home设为1。Shapedata类型的数据变量joint_space用来从指令WZHomeJointDef指令传送到WZDOSet指令。 项目: WZHomeJointDef [Inside] | [Outside] Shape MiddleJointVal DeltaJointVal [Inside]: 数据类型:switch 定义MiddleJointVal +/- DeltaJointVal范围内的关节空间。 [Outside]: 数据类型:switch 定义MiddleJointVal +/- DeltaJointVal范围外的关节空间(反关节空间)。 Shape: 数据类型:shapedata 存储定义的关键空间的变量(系统的私有数据private)。 MiddleJointVal: 数据类型:jointtarget 关节坐标系中即将定义的关节空间的中心位置。为每一个机器人轴和外部轴指定(对于旋转轴来说单位是度数,对于线形轴来说单位是毫米)。在绝对关节中指定(对于外部轴来说,不是在偏移坐标系EoffsSet-EoffsOn中)。对于某些轴来说9E9就是说轴不应该去理会。在编程中,不激活的外部轴也会给出9E9。 DeltaJointVal: 数据类型:jointtarget 在关节坐标系中,从关节空间的中心位置算起的+/-偏移位置。对于每一个要管理的轴来说,该数值必须大于0。 下图说明旋转轴的关节空间的定义。 下图说明了线性轴的关节空间的定义。 程序执行: 关节空间的定义存储在shapedata类型的变量中(项目Shape),以后在WZLimSup或者WZDOSet指令中使用。 如果和WZHomeJointDef指令一起还使用了WZDOSet,当所有带关节空间监视的、激活的轴即将进入或者已经进入关节空间的时候,才能设置数字输出信号。 如果和关节空间以外WZHomeJointDef(项目Outside)指令一起还使用了WZLimSup,当任何一个带关节空间监视的、激活的轴到达关节空间时,机器人立即停止。 如果和关节空间内WZHomeJointDef(项目Inside)指令一起还使用了WZLimSup,当最后一个带关节空间监视的、激活的轴到达关节空间时,机器人立即停止。这就是说,一个或者几个轴,但不是所有监视的、激活的轴可以同时位于关节空间内。 当执行ActUnit或者DeactUnit指令来激活或者解除机械单元的时候,HOME位或者工作区域限制位的管理状态将被更新。 限制: 只有激活的机械单元和他的激活的轴在world zone激活的时间段内 3.shapedata—World Zone 形状数据 用途: Shapedata用来描述World Zone的几何形状。 描述: World Zone可以定义为四个不同的几何形状: l 直立的箱体,所有的边都平行于world坐标系,由WZBoxDef指令定义。 l 一个球体,由WZSphDef指令定义。 l 一个圆柱体,平行于world坐标系的z轴,由WZCylDef指令定义。 l 机器人和/或外部轴的关节的一个空间区域,由指令WZHomeJointDef或者WZLimJointDef定义。 World Zone的几何形状由预览指令中的一个定义,World Zone的动作由指令WZLimSup和WZDOSet定义。 基本范例: 该数据类型的基本范例说明如下: 例1 VAR wzstationary pole; VAR wzstationary conveyor; … PROC … VAR shapedata volume; … WZBoxDef Inside, volume, p_corner1, p_corner2; WZLimSup Stat, conveyor, volume; WZCylDef Inside, volume, p_center, 200, 2500; WZLimSup Stat, pole, volume; ENDPROC 定义了一个箱体形状的conveyor,并且该区域的监视已经激活。一个圆柱形状的pole也已经定义,此区域的管理也已经激活。如果机器人到达以上区域中的一个,运动将被停止。 特征: Shapedata是一个非数值的数据类型。 End 文章来源:工控云学堂 本文系网络转载,版权归原作者所有。如涉及版权,请联系QQ2823408167删除! ▼
|
今日新闻 |
推荐新闻 |
CopyRight 2018-2019 办公设备维修网 版权所有 豫ICP备15022753号-3 |