MOVE_PT -- 单位时间距离

类型

特殊运动指令

描述

在一段时间内驱动电机运动设置的距离。

 

一般是PC每个周期计算好对应的坐标,然后传给控制器。

支持使用BASE指定轴。

运动时的速度=(DIS/TICKS)*1000 units/s。

不要在极短时间运动大距离,脉冲频率会过高,电机堵转,可以分解成小段,重复发送。

MOVE_PT指令新增多周期速度自动均匀功能。

语法

MOVE_PT (ticks, dis1,dis2…)

ticks:时间的伺服周期数,时间=系统周期*ticks

dis1:运动的距离

 

SERVO_PERIOD为1ms的控制器TICKS为1ms(不同SERVO_PERIOD的TICKS时间不一样)

适用控制器

通用

例子

例一

BASE(0)

UNITS=100

DPOS = 0

SPEED=100

ACCEL=1000

DECEL=1000

TRIGGER              '自动触发示波器

FOR i=0 TO 9

MOVE_PT (4, 10)            '在4tick内,运动10units,速度=2500 units/s

NEXT

WAIT IDLE

PRINT *DPOS            '打印结果,100

 

运动曲线

DPOS(0)垂直刻度100

MSPEED(0)垂直刻度2000

 

例二

BASE(0,1,2)

UNITS = 1000,1000,1000

ATYPE=0,0,0

DPOS = 0,0,0,0

SPEED=10,10,10,10

ACCEL=1000,1000,1000,1000

DECEL=1000,1000,1000,1000

MERGE = ON

TRIGGER

 

MOVE_PT(350,-20,-15,-25)'在350tick内,轴0,轴1,轴2运行-20,-15,-25的距离

MOVE_PT(350,20,15,25)'在350tick内,运行20,15,25的距离

MOVE_PT(350,-20,-15,-25)

MOVE_PT(350,20,15,25)

WAIT IDLE

 

运动曲线

DPOS(0)垂直刻度50

MSPEED(0)垂直刻度200

DPOS(1)垂直刻度50

MSPEED(1)垂直刻度200

DPOS(2)垂直刻度50

MSPEED(2)垂直刻度200

 

例三:

BASE(0)

UNITS = 100

ATYPE=0

DPOS = 0

SPEED=10

ACCEL=100

DECEL=100

 

DIM timeadd

DIM val1

DIM SPEEDval

timeadd=0

 

DPOS =100*COS(2*PI*0.2*timeadd+pi)+100

 

DELAY(1000)

TRIGGER

 

WHILE TRUE

       

        '周期=2π/|ω|

        'x=A*COS(ωx+ψ)+C       

       

        '求导得斜率,即速度:

        'v=-A*ω*SIN(ωx+ψ)

       

        val1=100*COS(2*PI*0.2*timeadd+pi)+100

       

        SPEEDval=-100*2*PI*0.2*SIN(2*PI*0.2*timeadd+pi)

       

        ?"val1="val1

        ?"SPEEDval="SPEEDval

       

        MOVE_PVTABS(10,val1,SPEEDval)

       

        'MOVE_PTABS(10,val1)

       

        timeadd=timeadd+0.01

       

        if timeadd>(2*PI/ABS(2*PI*0.2)*2) THEN

                EXIT WHILE

        ENDIF

WEND

DPOS(0)、MSPEED(0)垂直刻度150

相关指令

MOVE_PTABS