|
类型 |
机械手运动指令(主要针对scara机械手) |
|
描述 |
点位拱形运动(也称蛙跳指令),机械手末端拱形方式蛙跳一定高度再下降到目标点。如下图所示,点位拱形是由三段PTP形成的运动指令。该机械手指令对base设置的虚拟轴有效。 速度设置具体可见:该说明书“点位运动和轨迹运动的速度、加速度设置” |
|
语法 |
MOVER2_ARCHP(H_Pos,H1,H2,Fstatus,End_Pos1,End_Pos2,End_Pos3,End4,...) H_Pos:虚拟轴第3轴蛙跳的最大高度坐标值,即第3轴的绝对位置(如Z轴);单位mm H1:虚拟轴第3轴从起始点的提升高度;单位:mm H2:虚拟轴第3轴到目标点的下降高度;单位:mm Fstatus:若是SCARA,则是左右手系,0表示右手系,1表示左手系;若是六轴,表示确定唯一解的类型值,取值范围0~7。-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)。
备注: 1)拱形运动两边的提升高度是由H1和H2确定的,与ZSMOOTH无关。拱形运动倒角的曲线形态会随着各关节最大加速度设置的不同,会有些变化。 2)对于frame102的两轴并联机械手,只有2维坐标值,只设置End_Pos1和End_Pos2,H1和H2设置为0,H_Pos和P1、P2高度一致。 |
|
适用控制器 |
4系列20170511以上固件支持 |
|
例程 |
BASE(6,7,9,8) '选择虚拟轴号 CONNREFRAME(1,0,0,1,3,2) '启动正解连接;形成SCARA机械手正解模型 WAIT LOADED '等待运动加载,此时会自动调整虚拟轴的位置。 ?"正解模式"
BASE(6,7,8,9) MOVER2_PABS(0, 300, -100, -50,0) ‘右手系下PTP运行到目标点300,-100,-50 MOVER2_ARCHPABS(-25, 10, 20, 0, 300, -400, -50, 0) ‘右手系下,拱形运行的Z轴方向最高位置限制在-25mm,从起点Z轴提升高度10mm,Z轴下降高度20到目标点位置300,-400,-50。 |
|
相关指令 |
MOVER2_ARCHPL、MOVER2_ARCHP3 |