本文主要介绍如何使用MOVESYNC指令快速实现单轴/多轴同步跟随功能,适用于XYZ(R)、皮带等常见机械结构,在流水线点胶、流水线产品分拣、流水线产品搬运、流水线裁剪等场景中广泛应用。
一、同步跟随功能介绍
同步跟随的主要作用是快速控制运动机构,实现产线上产品的同步和跟随,再辅助其他运动指令实现产线产品的抓取、分拣、点胶等功能需求;同步跟随的功能主要由MOVESYNC指令实现,该指令方便用户通过程序快速实现单轴或多轴同步跟随功能,实现多皮带抓取摆放,属于凸轮指令的一种。
常见场景:流水线点胶、流水线产品分拣、流水线产品搬运、流水线裁剪等。
常见机械结构: XYZ (R)、皮带等。
二、MOVESYNC指令说明
1、指令介绍
同步跟随是指点的跟随,跟随的是位置,皮带与跟随轴的位置之间由算法去协调位置关系,需要处理的仅仅是第一个跟随时刻的位置。
MOVESYNC指令内重要参数是给出皮带的位置和跟随轴的位置,只需要把跟随点跟随的这个“时刻”静态化处理就行,即可以想象成当皮带上物体到了传感器mark位置时刻皮带停止了。
跟随轴这个时候移动到达产品mark点,这个时刻得到了两组坐标位置:
第一组: 皮带的位置syncposition。第二组: 跟随轴的位置pos1,只需要将这两个位置对应填进指令内即可,算子会自动计算规划两者位置,保证两者相对静止。
2、指令函数语法
MOVESYNC(mode,synctime,syncposition,syncaxis,pos1[,pos2,pos3…])
支持单轴或多轴同步跟随。
3、一般使用形式
base(0,1,2) //指定参与同步跟随轴号,这里以0,1,2为例
MOVESYNC (mode,加速时间,syncposition,syncaxis,pos1,pos2, pos3) //加速段
MOVESYNC(mode,同步时间,syncposition,syncaxis,pos1,pos2, pos3) //同步段
MOVESYNC(mode,减速时间,syncposition,syncaxis,pos1,pos2, pos3) //减速段(复位段)
一个完整的跟随过程分为三步,加工头先加速达到与皮带相同的速度,实现了同步运动,在同步段完成加工操作,然后加工头再回到等待位置,等待下一次触发加工。触发条件采用传感器检测来料,记录来料的位置,填入MOVESYNC指令。
4、指令参数说明
(1)mode:模式加速段和同步段一般使用模式0,一般是在X轴方向跟随,减速段一般使用模式-1(等待前面运动完成回到待机位置)。
特别说明: 当跟随的产线与机台存在夹角时使用模式0,并且加上机台与产线的夹角的弧度值实现跟随偏斜补偿,例:
mode=0+angle,angle:皮带旋转角度,角度=皮带与BASE第1/2轴的正向旋转夹角。例如:
① Mode=PI/4,皮带在45度的方向;
② Mode=PI/2,皮带在y方向;
③ Mode=PI,皮带在x负向;
④ Mode=(PI*1.75),皮带在-45度的方向;
(2)synctime:同步时间,时间单位ms,同步时间一般分为三段
加速段时间多久代表机台跟随轴加速达到产线速度,并且跟上目标产品,0表示根据运动轴的速度加速度来估计同步时间,可能不准确,一般相对设置长点,确保能实现同步;
同步段时间表示跟随产品运动多长时间,抓取等动作在此期间完成,一般相对设置较长,保证动作完成;
减速段时间表示多久回到指定位置,一般减速段时间和加速段一样,推荐使用-1模式;
(3)syncposition:皮带轴物体被感应到时皮带轴的位置
特别说明: 此指令支持皮带轴坐标循环,但是在指令被调用时确保此参数位置和当前皮带轴位置之间没有发生坐标修改或循环操作,因此此指令调用时不要在坐标循环点附近;
(4)syncaxis:皮带轴轴号,-1表示没有皮带轴,可以是电机轴,也可以是编码器
(5)pos1:皮带轴物体被感应到时的BASE第1个轴(一般是跟随轴)的绝对位置
(6)posn:皮带轴物体被感应到时的BASE第n个轴的绝对位置
5、指令使用图解(单轴为例)
movesync指令只需要给出同步跟随触发时的几个轴的位置参数即可,作为启动同步跟随的条件,再加速达到同步之后执行加工。首先构思搭建一个跟随模型,如下:
假设当产品到传感器位置时实现跟随;借助传感器的信号实现皮带位置锁存,即当产品到达传感器锁存的位置时,依靠锁存记录下皮带坐标(syncposition参数),此时将跟随轴X轴运行到产品锁存点位置,得到跟随轴X轴位置为(pos1);
这样就得到了MOVESYNC指令里面的坐标位置,即同步时刻皮带的位置(syncposition)、跟随轴的位置(pos1),再根据实际运行情况规划出加速段的时间、同步段的时间和减速段的时间,指令运行即可实现一次同步跟随过程。
三、实例演示
百度网盘代码提取二维码:
演示视频链接:运动控制器如何快速实现单轴/多轴同步跟随功能?