MOVER2_L/MOVER2_LABS -- 机械手直线运动

类型

机械手运动指令

描述

机械手末端直线运动到指定的目标点位姿。该机械手指令对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),手系依然为左手系。

相关指令