Skip to main content

zonedata

说明

描述机械臂在一个编程位置的转向区域。编程位置有两种类型,分别是停止点(stop point)和飞跃点(fly-by point),如果是stop point,则表示机械臂和外部轴必须到达该 位置,并且在到达该位置前不会执行下一条指令。如果是fly-by point,则机械臂不会到达 该位置,而是在靠近该位置时开始转向,并且在机械臂到达转向区域前程序开始执行下一条 指令。转向区域越大,转向越平滑,但转向区域半径不能超过编程位置与前后位置最近距离 的1/3,如果超过该范围,机械臂会自动调整该区域大小。

转向区域根据TCP位置到编程位置的距离定义为两个区域,第一个为重新定向区域,称作 extended zone,该区域半径为pzone_ori ,第二个为TCP路径区域,称作TCP zone,该区域 半径为pzone_tcp。TCP zone大小要小于extended zone,意即TCP不能先于工具方向进入角 路径,如果pzone_ori小于pzone_tcp,则会修改pzone_ori,使其与pzone_tcp相等。在TCP到达 extended zone区域时开始重新定向但此时TCP继续向编程位置靠近,当TCP到达TCP zone时 TCP转入角路径。

extended zone和TCP zone的大小会受到工具方向到编程位置方向的角度的影响,定义该角 度值为zone_ori比如从p1到p2, 如果pzone_ori与p1和p2距离的比值大于zone_ori与p1和p2 转角的比值,则会减小pzone_ori的值使比值相等。TCP进入角路径的位置也会受到zone_ori 的影响,如果pzone_tcp与p1和p2距离的比值大于zone_ori与p1和p2转角的比值,则会减小 pzone_tcp的值使比值相等。该现象称为区域缩小。意即,extended zone和TCP zone要保证 工具方向转至指定的范围内才进入角路径开始转向。

下面是区域缩小的例子,路径从P1经过P2到P3,P1和P2的距离len为200mm,P1和P2的角度 agl为50°,pzone_tcp = 60mm, pzone_ori = 90mm,zone_ori = 10°,

  • pzone_tcp/len = 30%
  • pzone_ori/len = 45%
  • zone_ori/agl = 20%

则会调整pzone_tcp 和pzone_ori 的值,使比值都为20%。

数据项

finep

  • 类型:bool
  • 说明:用于表示编程位置是停止点(fine point)还是飞跃点(fly-by point)

true表示是fine point,程序在机械臂到达停止点之前不会继续执行。

false表示是fly-by point,程序在机械臂到达zone之前会继续执行100ms。

如果让机械臂到达某个位置执行夹取或其他动作,一般将该位置设置为fine point。

pzone_tcp

  • 类型:num
  • 说明:用于表示TCP zone半径,单位为mm。

pzone_ori

  • 类型:num
  • 说明:用于表示extern zone的半径,单位为mm。该值应小于编程位置与前后位置最 近距离的1/3,大于pzone_tcp, 若该值过小则将其自动设置为与pzone_tcp 相等。

pzone_eax

  • 类型:num
  • 说明:带外部轴的extern zone半径,单位为mm。该值应小于编程位置与前后位置最 近距离的1/3,大于pzone_tcp, 若该值过小则将其自动设置为与pzone_tcp相等。

zone_ori

  • 类型:num
  • 说明:用于表示重定向区域的大小,单位为degrees。如果机械臂夹持着工件,则该 值表示工件旋转的角度。

zone_leax

  • 类型:num
  • 说明:带线性外轴的重定向区域大小,单位为mm。

zone_reax

  • 类型:num
  • 说明:带旋转外轴的重定向区域大小,单位为degrees 。
Namepzone_tcp(mm)pzone_ori(mm)pzone_eax(mm)zone_ori(°)zone_leax(mm)zone_reax(°)
fine000000
z00.30.30.30.030.30.03
z11110.110.1
z55880.880.8
z101015151.5151.5
z151523232.3232.3
z202030303.0303.0
z303045454.5454.5
z404060606.0606.0
z505075757.5757.5
z606090909.0909.0
z80801201201212012
z1001001501501515015
z1501502252252322523
z2002003003003030030