《运动控制器的程序设计》由会员分享，可在线阅读，更多相关《运动控制器的程序设计（11页珍藏版）》请在金锄头文库上搜索。
1、-运动控制器的程序设计 本系统采用的下位机为翠欧运动控制器MC206，根据本课题的要求，为了方便进展系统的调试和控制，缠绕机的工作方式分为手动、自动和半自动三种7。手开工作状态是单独控制小车轴和主轴的运动来实现指定缠绕；自开工作状态是控制主轴和小车同步运动；半自开工作状态是运用其BASIC语言用电子齿轮运动，其中齿轮比是可调的。自动控制方式下，为实现玻璃钢的锥形的同步缠绕，Trio basic语言中的MOVELINK命令可以实现主轴和小车的运动，通过设定连接轴和被连接轴的加减速的距离，从而实现预期缠绕。以下为自动的控制方式下的流程图： 开场 自动 选择主轴0 零点校正 启动缠绕 读取参数Y 程
2、序退出 到达缠绕层数？YN到达来回数？自动加减速缠绕NMOVELINK为运动控制类命令，在根本轴产生直线运动，并通过电子齿轮比与连接轴的测量位置连接。其具体使用格式如下：MOVELINK(distance，link dist,link acc,link dec,link a*is,link options,link start)具体参数含义：distance 连接开场至完毕当前基准轴连接轴增量运动距离；link dist 在用户单位下，从连接开场到完毕，被连接轴主轴移动的正向距离；link acc 基准轴加速过程中，主轴转过的正向距离；link dec 基准轴减速过程中，主轴转过的正向距离；l
3、ink a*is 连接轴、主轴；link options 1当主轴色标信号触发时，从轴与主轴开场连结; 2当主轴运动到设定的绝对位置，从轴与主轴开场连结; 4 MOVELINK自动重复连续双向运行。设置REP_OPTION=1，取消此操作; link pos 这个参数是绝对位置，当参数6设成2，MOVELINK在这个位置开场连结; 参数6和7可选。其中，参考参数为A*IS，REP_OPTION，UNITS参数说明，连接轴可以向任意方向驱动输出，根本轴的距离使得连接轴移动相应的距离。连接轴驱动基准轴的移动距离可以分成三个阶段分别是加速、匀速、减速局部。其中加速度和减速由link acc和link
4、 dec参数设置。常速连接距离由总连接距离和以上两个参数。这三个阶段可以用三个独立的MOVELINK指令也可以将其叠加在一条指令中。并且使用本指令有两条规律。规律一：在加速和减速阶段为了与速度匹配，link dist是distance的两倍。规律二：为了满足速度需要，在常速阶段，两轴必须要运动一样的距离，其运动距离与link distance 是一样的。MOVELINK工作在缺省轴，除非A*IS定义其它根本轴，link a*is设置驱动根本轴。注意：假设link acc和link dec的和大于link dist,则它们要成比例的减少并使得两者的总和等于link dist。举例说明该语句的使用
5、方法和功能：例：飞剪以纸的速度在运动，每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 ；匹配速度然后减速WAIT UNTIL NTYPE=0 ；等待到最后运动开场OP 0，ON ；激活剪子MOVELINK -1，8.2，0.5，0.5，1 ；返回在这个程序中，MC控制单元开场等待滚动150米。在这个距离之后，飞剪加速匹配纸的速度常速运行，再
6、减速至停顿，不超过1米的距离。这个运动使用两MOVELINK指令。程序于是等待下一运动缓存去除NTYPE=0。这说明加速阶段完成。连结轴主轴的距离在MOVELINK指令中是：150，0.8，1.0，8.2，总共160米。确定速度，飞剪位置和纸在剪切任务中匹配。MOVELINK指令的参数必须正确。因此，最先分别考虑加速度，常速和减速阶段是最简单的。这象以上述的，加速和减速阶段需要Link distance是distance的两倍。两个阶段可以定义为：MOVELINK 0.4，0.8，0.8，0，1 此为全加速运动MOVELINK 0.4，0.8，0，0.8，1 此为全减速运动常速阶段匹配速度，两
7、轴运行一样的距离，因此，运动距离和连结距离相等。常速阶段定义如下：MOVELINK 0.2，0.2，0，0，1 此为全常速运动MOVELINK指令允许三部的distance，link distance，link_acceleration，link_deceleration参数相加。产生如下指令：MOVELINK 1，1.8，0.8，0.8，1在以上程序中，加速阶段独立编程。这可以在加速完毕阶段执行一些动作。MOVELINK 0.4，0.8，0.8，0，1MOVELINK 0.6，1.0，0，0.8，1假设本系统中锥形管的长度为L,为了实现它的均匀缠绕，主轴做匀速旋转，并且其所在的轴为轴0，小车
8、也称工作台做加速，匀速，减速的过程，其所在的轴为轴1。 在进展锥形管缠绕时，为了实现稳定缠绕，这里提出了一种运动方案，因为是进展锥形缠所以，导丝头运动轨迹沿着锥形管外侧母线运动，并且锥形管芯模和小车带动的导丝头两者之间的距离是一定不变的，这样可以使得导丝头加速，匀速，和减速。其一个来回导丝头的运动示意图：23148576设置参数行程均：1 小车工作台：Lacc，主轴：Macc ; 2 小车：Lconst，主轴：Mconst; 3 小车：Ldec.主轴：Mdec; 4小车：0，主轴：Mstop; 5小车：-Ldec,主轴：Macc; 6小车：-Lconst,主轴：Mconst; 7小车：-Lac
9、c,主轴：Macc; 8小车：0，主轴：Mstop-。 且一般的Lacc不等于Ldec的值。如此循环进展缠绕。 Trio Basic语言有广泛的通用性,其部有三种不同类型的存储变量：VR变量、TABLE区变量、命名变量。命名变量是局部变量，所以仅在定义它的任务围是有效变量。VR变量是全局变量，可以被多个子程序共同使用并且可用于各个任务间通讯；TABLE区一般是用于存储CAMCAMBO*指令曲线的。本程序运用的的是VR变量。选取VR变量区，从VR300开场定义变量。定义：VR(300)=Lacc；加速1段小车的行程转数VR(302)=Macc；加速1段主轴的行程VR(304)=Lconst；匀速
10、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; 满足生产工艺缠绕层数由此，可以进展编程：WDOG=ON;BASE(0);CANCEL;CANCEL;CANCEL;FOR J=1 TO VR(318)FOR I=1 TO VR(316) ；进入循环缠绕到达一定的层数MOVELINK(VR(300)，VR(302)，VR(302)，0，0
11、)；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)；NE*T INE*T JPRINT “Done 由上述可知，控制方式分为三种。为了方便调试和运行，本系统还设置了手动控制方式，即
12、单独控制主轴和小车的运动。这三种控制方式可以用以下列图来表示。+24v IN0 IN1 IN2 IN3 IN4 IN5 IN6 IN7 MC206其中，IN0接通高电平表示自动控制方式；IN1接通表示半自动控制方式；如果以上两种方式都不接通则即表示为手动控制方式，可以采用三位两通式的选择开关不可自动复位。 IN2接通表示主轴加速； IN3接通高电平表示主轴减速，并且两者不可同时接通，带有自动复位的功能。 同理IN4 和IN5分别表示小车正向加减速输入，类似主轴加减速使用的开关； IN6和 IN7分别表示小车反向加减速输入。在手动控制方式下，设置变量分别表示不同的控制方式,用变量MYMODE表示
13、控制方式。IF IN0=1 THEN MYMODE=1 IF IN1=1 THEN MYMODE=2 ENDIFELSE MYMODE=3 ENDIF小车的动作可分为正向运动和反向运动，这里所说的正向是与主轴旋转的同方向来规定的。因此也需要设置变量来表示小车的运动反方向从而更准确的进展手动控制前进或者后退的距离。这里设置HEAD和BACK分别表示。IF IN2=1 THEN HEAD=1ELSE IF IN3=1 THEN HEND=1 ELSE HEAD=0 ENDIFENDIFIF IN4=1 THEN BACK=1ELSE IF IN5=1 THEN BACK=1 ELSE BACCK=
14、0 ENDIFENDIF 通过设置变量能够更清晰的编写程序，首先根据手动控制画出程序流程图，图中有些环节直接用变量来进展判断。下列图为手动方式下的程序流程图： 开场YN 退出MYMODE=3N小车正向？N小车反向？Y减速？ 加速？NYNYY小车减速运动加速？小车加速运动YN小车加速运动N减速？Y小车减速运动主轴有无输入？NNYN减速？加速？YY主轴减速运动主轴加速运动根据程序流程图可以进展如下编程：*ubhaun: IF MYMODE=3 THENIF HEAD=1 THEN IF IN4=1 THEN MSPEED=MSPEED+1 ELSE IF IN5=1 THEN MSPEDD=MSPEED-1
