MOVER2_ARC/MOVER2_ARCABS -- 机械手圆弧插补

类型

机械手运动指令

描述

空间圆弧运动,即也包含了平面圆弧;输入参数是圆弧的中间点和终点。

该机械手指令对base设置的虚拟轴有效。

语法

MOVER2_ARC(Fstatus, midx, midy, midz,endx, endy, endz, enda, endb, endc)

Fstatus:若是SCARA,则是左右手系,0表示右手系,1表示左手系;若是六轴,表示确定唯一解的类型值,取值范围0~7。-1表示当前的姿态。

midx:圆弧中间点的X轴绝对位置值;单位:mm

midy:圆弧中间点的Y轴绝对位置值;单位:mm

midz:圆弧中间点的Z轴绝对位置值;单位:mm

endx:圆弧目标点的X轴绝对位置值;单位:mm

endy:圆弧目标点的Y轴绝对位置值;单位:mm

endz:圆弧目标点的Z轴绝对位置值;单位:mm

enda:若是六自由度机械手,表示圆弧目标点姿态的欧拉角RX角;若是SCARA,表示圆弧目标点姿态的Rx轴旋转角。单位:度

endb:若是六自由度机械手,需填写该值,表示圆弧目标点姿态的欧拉角RY角;而SCARA不需填写。单位:度

endc:若是六自由度机械手,需填写该值,表示圆弧目标点姿态的欧拉角RZ角;而SCARA不需填写。单位:度

若后面End7、End8、End9等继续添加的参数,则为外扩轴的目标值,量纲单位根据用户设置的情况,可设置为旋转轴(单位:度)或移动轴(单位:mm)。

适用控制器

4系列20170511以上固件支持

例程

BASE(6,7,8,9) '选择虚拟轴号

CONNREFRAME(1,0,0,1,2,3) '启动正解连接。  

WAIT LOADED '等待运动加载,此时会自动调整虚拟轴的位置。

?"正解模式"

 

BASE(6,7,8,9)

MOVER2_ARC(0, 50, 50, -10, 100, 0, -10, 0)  ‘右手系下,机械手经中间点(50,50,-10)圆弧插补运行到目标点(100,0,-10)。

相关指令