运动控制器的程序的设计说明Word文档格式.docx

运动控制器的程序的设计说明Word文档格式.docx

《运动控制器的程序的设计说明Word文档格式.docx》由会员分享，可在线阅读，更多相关《运动控制器的程序的设计说明Word文档格式.docx（9页珍藏版）》请在冰豆网上搜索。

4MOVELINK自动重复连续双向运行。

设置REP_OPTION=1,取消此操作；

linkpos这个参数是绝对位置，当参数6设成2,MOVELINK在这个位置开始连结；

参数6和7可选。

其中，参考参数为AXIS,REPOPTION,UNITS

参数表明，连接轴可以向任意方向驱动输出，基本轴的距离使得连接轴移动相应的距离。

连接轴驱动基准轴的移动距离可以分成三个阶段分别是加速、匀速、减速部分。

其中加速度和减速由linkacc和linkdec参数设置。

常速连接距离由总连接距离和以上两个参数。

这三个阶段可以用三个独立的MOVELINK指令也可以将其叠加在一条指令中。

并且使用本指令有两条规律。

规律一：

在加速和减速阶段为了与速度匹配，linkdist是distance的两倍。

SPeeddistance

规律二：

为了满足速度需要，在常速阶段，两轴必须要运动相同的距离，其运动距离与linkdistance是相同的oMOVELINKX作在缺省轴，除非AXIS定义其它基本轴，linkaxis设置驱动基本轴。

注意：

若linkacc和linkdec的和大于linkdist,则它们要成比例的减少并使得两者的总和等于linkdisto

举例说明该语句的使用方法和功能：

例：

飞剪以纟氏的速度在运动，每160米剪掉滚动的纸。

飞剪可以运动到1.2米，此例中使用运动1米的距离。

纸的运行长度由编码器测量得出。

两轴的单位转换

因子设置成米。

轴1是连接轴。

MOVELINK（0,150,0,0,1）

MOVELINK（0.4,0.8,0.8,0,1）

MOVELINK（0.6,1.0,0,0.8,1）

WAITUNTILNTYPE=0

OP（0,ON）

MOVELINK（-1,8.2,0.5,0.5,1）

在这个程序中，MC控制单元开始等待滚动

;

等待距离

加速度

匹配速度然后减速

等待到最后运动开始

激活剪子

返回

150米。

在这个距离之后，飞剪加速

匹配纟氏的速度常速运行，再减速至停止，不超过1米的距离。

这个运动使用两

MOVELINK指令。

程序于是等待下一运动缓存清除NTYPE=0o这表明加速阶段完成。

连结轴（主轴）的距离在MOVELINK指令中是：

150,0.8,1.0,&

2,总共160米。

确定速度，飞剪位置和纸在剪切任务中匹配。

MOVELINK指令的参数必须正确。

因此，最先分别考虑加速度，常速和减速阶段是最简单的。

这象以上述的，加速和减速阶段需要Linkdistance是distance的两倍。

两个阶段可以定义为：

MOVELINK（0.4,0.8,0.8,0,1）'

此为全加速运动

MOVELINK（0.4,0.8,0,0.8,1）'

此为全减速运动

常速阶段匹配速度，两轴运行相同的距离，因此，运动距离和连结距离相等。

常速阶段定义如下：

MOVELINK（0.2,0.2,0,0,1）'

此为全常速运动

MOVELINK指令允许三部的distance,linkdistance,linkacceleration,linkdeceleration参数相加。

产生如下指令：

MOVELINK（1,1.8,0.8,0.8,1）

在以上程序中，加速阶段独立编程。

这可以在加速结束阶段执行一些动作。

假设本系统中锥形管的长度为L,为了实现它的均匀缠绕，主轴做匀速旅转，并且其所在的轴为轴0,小车也称工作台做加速，匀速，减速的过程，其所在的轴为轴1。

在进行锥形管缠绕时，为了实现稳定缠绕，这里提出了一种运动方案，因为是进行锥形缠所以，导丝头运动轨迹沿着锥形管外侧母线运动，并且锥形管芯模和小车带动的导丝头两者之间的距离是一定不变的，这样可以使得导丝头加速，匀速，和减速。

其一个来回导丝头的运动示意图：

设置参数行程均已知:

1小车（工作台）：

Lacc,主轴：

Macc；

2小车：

Lconst,主轴：

Mconst；

3小车：

Ldec.主轴：

Mdec；

4小车：

0,主轴：

Mstop；

5小车：

-Ldec,主轴：

Macc；

6小车：

-Lconst,主轴：

7小车：

-Lacc,主轴：

8小车：

0,主轴:

Mstop-®

且一般的Lacc不等于Ldec的值。

如此循环进行缠绕。

TrioBasic语言有广泛的通用性，其部有三种不同类型的存储变量:

VR变量、TABLE区变量、命名变量。

命名变量是局部变量，所以仅在定义它的任务围是有效变量。

VR变量是全局变量，可以被多个子程序共同使用并且可用于各个任务间通讯；

TABLE区一般是用于存储CAM/CAMBOX指令曲线的。

本程序运用的的是VR变量。

选取VR变量区，从VR（300）开始定义变量。

定义：

VR（300）=Lacc；

加速1段小车的行程（转数）

VR（302）=Macc；

加速1段主轴的行程

VR（304）=Lconst；

匀速2段小车的行程

VR（306）=Mconst；

匀速2段主轴的行程

VR（308）=Ldec；

减速3段小车的行程VR（310）=Mdec；

减速3段主轴的行程

VR（312）=Mstopw；

停止4段主轴的行程

VR（314）=Mstoph；

停止8段主轴的行程

VR（316）=I；

布满芯模表面需要来回数

VR（318）=J；

满足生产工艺缠绕层数

由此，可以进行编程：

WD（）G=0N；

BASE（0）；

CANCEL；

FORJ=1TOVR（318）

FOR1=1TOVR（316）；

进入循环缠绕达到一定的层数

MOVELINK（VR（300）,VR（302）,VR（302）,0,0）；

MOVELINK（VR（304）,VR（306）,0,0,0）；

MOVELINK（VR（308）,VR（310）,0,VR（310）,0）；

MOVELINK（0,VR（312）,0,0,0）；

MOVELINK（-VR（308）,VR（310）,VR（310）,0,0）；

MOVELINK（-VR（304）,VR（306）,0,0,0）；

MOVELINK（-VR（300）,VR（302）,0,VR（302）,0）；

MOVELINK（0,VR（314）,0,0,0）；

NEXTI

NEXTJ

PRINT“Done”

由上述可知，控制方式分为三种。

为了方便调试和运行，本系统还设置了手动控制方式，即单独控制主轴和小车的运动。

这三种控制方式可以用以下图来表

+24v

其中,IN0接通高电平表示自动控制方式；

IW1接通表示半自动控制方式；

如果以上两种方式都不接通那么即表示为手动控制方式，可以采用三位两通式的选择开关不可自动复位。

IN2接通表示主轴加速；

IN3接通高电平表示主轴减速，并且两者不可同时接通，带有自动复位的功能。

同理IN4和IN5分别表示小车正向加减速输入，类似主轴加减速使用的开关；

IN6和IN7分别表示小车反向加减速输入。

在手动控制方式下，设置变量分别表示不同的控制方式，用变量MYMODE表示控制方式。

IFINO=1THENMYM（）DE=1

IFIN1=1THENMYM0DE=2

ENDIF

ELSEMYMODE二3

小车的动作可分为正向运动和反向运动，这里所说的正向是与主轴旋转的同方向来规定的。

因此也需要设置变量来表示小车的运动反方向从而更精确的进行手动控制前进或者后退的距离。

这里设置HEAD和BACK分别表示。

IFIN2=1THENHEAD=1

ELSEIFIN3=1THENHEND=1

ELSEHEAD=0

IFIN4=1THENBACK=1

ELSEIFIN5=1THENBACK=1

ELSEBACCK=0

通过设置变量能够更清晰的编写程序，首先根据手动控制画出程序流程图，图中有些环节直接用变量来进行判断。

下图为手动方式下的程序流程图:

小车加速运

小车减速运

主轴加速运

主轴减速运

根据程序流程图可以进行如下编程:

Xubhaun：

IFMYM0DE=3THEN

IFHEAD二1THEN

IFIN4=1THENMSPEED二MSPEED+1

ELSEIFIN5=1THENMSPEDD二MSPEED-l

FORWORD（MSPEED）AXIS（l）

ELSEBACK=1THEN

IFIN6=1THENMPEED二MSEED+1

ELSEIFIN7=1THENMSPEED二MSPEED-1

REVERSE（MSPEED）AXIS（l）

IFIN2=1THENMSPEED二MSPEEED+1

ELSEIFIN3=1THENMSPEED二MSPEED-1

FORWORD（MSPEED）AXIS（O）

GOTOXunhuan

运动控制指令

语法：

REVERSE

备选：

RE

说明：

REVERSE反向连续运动，速度由SPEED参数设置。

加速率由ACCEL参数设置。

REVERSE工作在缺省基本轴，除非AXIS定义临时基本轴。

反向运动可以被CANCEL或RAPIDSTOP指令停止。

或到达反向限位，禁止或原点返回。

参阅：

AXIS,CANCEL,FORWARD,RAPIDSTOP

例子：

back：

WAITUNTILIN（