MOVER2_P/MOVER2_PABS -- 机械手点位运动

类型

机械手运动指令

描述

机械手末端通过点到点(PTP)关节插补联动运行到指定的目标点位姿。该指令与MOVER2_J功能一样,只是输入的是目标点位姿。

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

语法

MOVER2_P/MOVER2_PABS(Fstatus,End_Pos1,End_Pos2,End_Pos3,End4,...)

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

End_Pos1:机械手虚拟轴的第1轴目标值(如X轴);单位:mm

End_Pos2:机械手虚拟轴的第2轴目标值(如Y轴);单位:mm

End_Pos3:机械手虚拟轴的第3轴目标值(如Z轴);单位:mm

End4:若是六轴机械手,表示目标点姿态的欧拉角RX角;若是SCARA,表示直线目标点姿态的RX轴旋转角。单位:度

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

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

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

适用控制器

4系列 20170511以上固件支持

例程

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

CONNREFRAME(6,0,0,1,2,3,4,5)  '六自由度机械手模型,第0~5轴作为关节轴号

?"正解模式"

 

BASE(6,7,8,9,10,11)

FORCE_SPEED=0.8  ‘设置下面执行的MOVER2_PABS点位运动速度为0.8,即速度设置为满速的80%

 

MOVER2_PABS(3,374,0,630,0,90,0)  ‘表示机械手走PTP关节插补运行到目标坐标值(374,0,630),目标姿态值(0,90,0),处于Fstatus=3的唯一解区域。

MOVER2_PABS(-1,189,-160,600,0,90,0);  ‘表示机械手走直线路径运行到目标坐标值(189,-160,600),目标姿态值(0,90,0)不变,依然处于Fstatus=3的唯一解区域。

相关指令

MOVER2_J/MOVER2_JABS