|
类型 |
机械手运动指令 |
|
描述 |
机械手末端直线运动到指定的目标点位姿。该机械手指令对base设置的虚拟轴有效。 速度设置具体可见:该说明书“点位运动和轨迹运动的速度、加速度设置” MOVER2_LABS——表示绝对位置方式下走直线 MOVER2_L——表示增量位置方式下走直线 |
|
语法 |
MOVER2_L/MOVER2_LABS(Fstatus,End_Pos1,End_Pos2,End_Pos3,End4,End5...) 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)。 备注: 1)MOVER2_L为相对位姿的增量编程方式。对于frame102的两轴并联机械手,只有二维坐标值,则只设置End_Pos1和End_Pos2。 2)直线轨迹的线速度及加速度设置可参考如下示例。 |
|
适用控制器 |
4系列20170511以上固件支持 |
|
例程 |
''''''''''''''电机、机械手参数定义 dim R1 '上间距半径 dim r2 '下间距半径 dim L1 '上杆长度 dim L2 '下杆长度 R1 = 40 delta机械手结构相关参数 r2 = 27 L1 = 120 L2 = 230
dim u_m1 '电机1一圈脉冲数 dim u_m2 '电机2一圈脉冲数 dim u_m3 '电机3一圈脉冲数 dim u_m4 '电机4一圈脉冲数 u_m1=480000 u_m2=480000 u_m3=480000 u_m4=640000
dim i_1 '关节1传动比 dim i_2 '关节1传动比 dim i_3 '关节1传动比 dim i_4 '关节1传动比 i_1=31 i_2=31 i_3=31 i_4=1
dim u_j1 '关节1转一圈的电机脉冲数 dim u_j2 '关节2转一圈的电机脉冲数 dim u_j3 '关节3转一圈的电机脉冲数 dim u_j4 '末端旋转一圈的电机脉冲数 u_j1=u_m1*i_1 u_j2=u_m2*i_2 u_j3=u_m3*i_3 u_j4=u_m4*i_4
''''''''''''''''关节轴设置'''''''''''''''''''''''''''''''''''''''''' base(0,1,2,3) '定义实际轴 'atype = 1,1,1,1 '设置为脉冲轴 units=u_j1/360,u_j2/360,u_j3/360,u_j4/360 'units设为每°的脉冲 FS_LIMIT = 90,90, 150,720 '机械手各关节轴正负限位值 RS_LIMIT = -90,-90, -150,-720 dpos=0,0,0,0 '设置关节轴的位置,此处要根据实际情况来修改 mpos=0,0,0,0 SPEED=500,500,500,1500 '设置各关节轴的最大速度ACCEL=10000,10000,10000,30000 '设置各关节轴的最大加速度和减速度 DECEL=10000,10000,10000,30000
''''''''''''''虚拟轴设置''''''''''''''''''''''''''''''''''''''''''''''''' base(6,7,8,9) atype = 0,0,0,0 '设置为虚拟轴 TABLE(0,R1,r2,L1,L2,u_j1,u_j2,u_j3, 0, 0, 0, u_j4 ) UNITS = 1000,1000,1000,u_j4/360 '此脉冲当量要提前设置,中途不能变化 FS_LIMIT = 20000000,20000000, 20000000,2000000 RS_LIMIT = -20000000,-20000000, -20000000,-2000000 accel=30000,30000,30000,30000 decel=30000,30000,30000,30000 FORCE_SPEED(6) = 3000 '直线轨迹线速度设置,6为虚拟主轴号;只有虚拟主轴号的线速度3000起作用,虚拟轴号7、8的速度不起作用。 FORCE_SPEED(9) = 1500 '末端旋转轴Rx旋转速度设置;9为delta旋转轴轴号
base(6,7,8,9) '选择delta机械手虚拟轴号 CONNREFRAME(14,0,0,1,2,3) '第0/1/2/3轴为关节轴,启动正解连接 wait loaded wa(10) ?"正解模式"
SYSTEM_ZSET=0'看分轴的速度 trigger
'delta工艺点位 base(6,7,8,9) mover2_labs(-1,116.56,8.92117,-211,89.66428) wait idle(0)
BASE(6,7,8,9) '选择虚拟轴号 CONNREFRAME(14,0,0,1,2,3) '启动正解连接。 WAIT LOADED '等待运动加载,此时会自动调整虚拟轴的位置。 ?"正解模式" BASE(6,7,9,8) SPEED_RATIO = 1.0 '速度比例值为1.0 ZSMOOTH=100 '平滑系数设置为100 MOVER2_LABS(1,300,200,-50,0) '表示SCARA机械手从当前位姿走直线路径运行到目标点(300,200,-50,0),手系为左手系。 MOVER2_LABS(-1,400,300,-100,0); ‘表示SCARA机械手走直线路径运行到目标点(400,300,-100,0),手系依然为左手系。 |
|
相关指令 |
|