1、武汉若比特机器人有限公司1 / 5基于嵌入式运动控制器的缠绕机控制系统引言玻璃钢管具有耐腐蚀内壁光滑流体阻力小对输送介质无二次污染保温性能好和工程造价低等诸多优点，使其成为传统钢管的最佳替代品，在输油输水、化工和热电工程中得到广泛应用据报导,2001 年西欧玻璃钢管的市场需求量达到 6.7 万吨,且年增长率在 10%以上,世界上各大知名玻璃钢管生产企业纷纷加强研发力量,极大促进了玻璃钢管工业的发展目前,世界各国生产玻璃钢管的主要方法是纤维缠绕成型法缠绕机是纤维缠绕成型的关键设备,工作时,浸渍胶粘剂的纤维纱片通过缠绕机小车上的丝嘴按设计的线型有规律地铺敷在芯模表面上形成缠绕层,多层缠绕后形成端部
2、带有阴螺纹的缠绕构件本文研制的缠绕机为卧式,芯模水平放置缠绕时,芯模绕其主轴匀速转动，小车电机拖动小车沿芯模轴向往复运动,带动绕丝嘴按一定缠绕角度完成纤维在芯模上的缠绕铺放,达到制品的技术要求模块化开放式数控系统已成为当今数控技术的发展方向,本文的缠绕控制系统采用嵌入式多任务运动控制器实现主轴和小车的同步运动控制和缠绕逻辑控制讨论了基于 PC 机和 TRIO 运动控制器的开放式缠绕机数控系统的开发玻璃钢管缠绕机控制系统结构缠绕机由带动玻璃钢管芯模旋转的主轴对芯模排布玻璃纤维的小车和树脂以及固化剂供给系统等设备组成卧式缠绕机缠绕工作时,芯模绕其主轴匀速转动,小车电机拖动小车在工作台上沿纵向往复运
3、动,带动绕丝嘴按一定缠绕角度完成纤维层在芯模上的缠绕铺放工作小车电机在往复运行时要根据工艺要求不断进行加减速，而且小车和主轴负载随着缠绕胶量的变化而变化，易造成导丝头和芯模的相对位置的变化，从而造成线型异变和纱片搭接不良缠绕机系统为一个惯量变化很大的非线性时变位置同步随动控制系统，因此，采用基于电子齿轮的位置跟踪控制方式以确保纱片搭接良好电子齿轮模式实际上是一个多轴联动模式 ，其运动效果与两个机械齿轮的啮合运动类似当前轴工作在电子齿轮模式下时，需设定电子齿轮传动比，当前轴将按照这个速度比值，跟随主动轴运动主动轴的运动模式可以是任何一种运动模式当前轴运动位移增量等于与之相联系的主动轴的位移增量乘
4、以电子齿轮传动比武汉若比特机器人有限公司2 / 5该缠绕机控制系统结构如图 I 所示上位机采用台湾研华 1PC610 机箱和 PcA-6179 主板，它与英国 Motion Technology 公司的 MC206 运动控制器通过 RS-232 串口实现通讯，形成一个功能强大的开放式运动控制系统工业 PC 机负责人机界面管理、运动状态显示远程监控和工艺文件存储等功能，运动控制器负责实时运动控制和逻辑控制，该结构支持软件升级和功能扩展，具有上、下两级的开放性缠绕机主轴电机是 7.5kW 的三相交流异步电动机，用日本安川 ICIMR-G7A47p5 变频器驱动对于主轴电机的速度，本系统采用了抗负载
5、变化能力较大的闭环控制方式运动控制器轴 3 接口的模拟量输出作为变频器速度控制输入信号，在运动控制器开环控制状态下设置模拟量电压输出值实现变频器速度控制安装于变速箱输入轴上的 CWZ1X 旋转编码器完成主轴转角和速度的检测变频器采用带 PG 矢量控制方式，PG-X2 速度卡把编码器采样的信号一路作为变频器输入实现速度闭环控制，一路作为速度和位置信号输入到控制器的编码器接口4，实现了由一个编码器完成速度闭环控制和主轴转角位置采样的功能小车采用安川 SGMGH-44ACA61 伺服电机完成精确定位，它沿玻璃钢管轴向往复运动，按照缠绕规律以一定的响应速度和精度跟踪主轴运动轴 0 接口工作于伺服模式，
6、完成小车伺服电机的闭环控制主轴编码器反馈接到 MC206 轴 4 接口，作为参考编码器的输入轴，为小车同步运动提供一个编码器输入缠绕机控制系统软件设计武汉若比特机器人有限公司3 / 5缠绕机控制系统上位机程序采用 Microsoft 公司的 VC+6.0 基于Windows2000 平台开发，完成工艺文件设置和管理、远程监控和机床运行状态显示等功能工控机和 MC206 通过串口基于 MODBUS 协议完成工艺参数下载和机床状态参数上传显示通讯采用主从方式的查询机制，系统将工控机设为主站，MC206 设为从站，只有主站发出查询时，从站才能给出响应，从站不能主动发送数据工作时工人选定待缠绕管件型号
7、并将工艺文件下载后，进入缠绕加工状态，此时所有运动和逻辑控制由完成，从站仅响应主站的查询并上传状态数据即使工控机由于某种原因出现故障或死机，也不会影响当前管道的缠绕加工从而提高了系统的稳定性和控制的实时性运动控制程序采用 Trio BASIC 多任务语言编制通过运行在 PC 机上的Motion Perfect 软件将编制好的运动控制程序下载到 MC206 内即可脱机运行Trio BASIC 语言有三种不同类型的存储变量: 命名变量、VR() 变量和 TABLE区变量命名变量是局部变量，仅在定义它的任务内有效变量是可被多个任务共享的全局变量，它可用于任务间通讯；TABLE 区通常是用于存储 CA
8、M/指令曲线的存储区，本程序用于存储缠绕管道型号的工艺文件运行的用户程序被称为线程或任务对于复杂的多任务程序应为线程分配优先级,控制器缺省的伺服周期是1ms，该周期在内部被分成三个时间片，每个时间片为 1/3ms，它们在内部分别被用来处理伺服功能，通讯和通常的“housekeep-“ 任务在每个时间片内剩余的时间被用于运行用户程序MC206 最多可运行 7 个用户线程，每个线程用从1 到 7 的数字标号，最高标号的线程(线程 7 和 6 ) 被分配固定的时间片，它们被称为” 快速任务“ ，主要用于有以下要求的任务: 要在每个伺服周期都要进行处理的任务； 具有大量的运算和处理的任务； 任务启动后
9、程序执行速度不能改变的任务 5 g - 线程被称为“慢速任务”，它们具有共同的优先级，程序执行速度会随任务的增加而降低用户可以使用指令启动任务使其按指定的优先级运行.在上位机软件 Motion Perfect 中打开一个“Terminal”窗口可以设置一个“Command Line”端 口，它始终使用“0”号任务，用于从上位机输入指令并武汉若比特机器人有限公司4 / 5立即运行 该缠绕机控制软件中共建立了四个任务，其中任务 7 用于缠绕机电机运动控制和机床逻辑控制，任务 6 用于管理机床与缠绕相关的 I/O 信号和主轴转速控制，任务 2 完成串口通讯功能，任务 1 实现输胶控制控制程序的任务功
10、能和执行时间分配如图 2 所示其中任务 7 和 6 的优先级最高，每个伺服周期(1Ins ) 都分配时间片，任务 1，2 和/ L) 优先级相同，在每个伺服周期轮流为其分配时间片缠绕程序任务功能和执行时间的分配如图 2 所示 缠绕机加工控制工作状态分为手动、半 自动和自动三种状态手动状态用于单独控制芯模和小车的运动半自动状态下芯模和小车协调运动进行环向缠绕，缠绕的长度由工人控制自动工作状态下可按工艺文件设定参数实现环向和螺旋 自动缠绕此外控制程序还具有零点校正、自动零点、断点缠绕和缠绕过程人工干预等功能结束语该缠绕机数控系统结合了工业 PC 机和嵌入式运动控制器的优点，充分利用了 TRIO 运动控制器的电子齿轮功能系统可以根据工艺要求进行自动缠绕，并具有系统运行状态显示、远程通讯、故障诊断与报警和反向间隙补偿等功能该缠绕机纱片宽度在 80220mm 之间任意调节，可满足不同管径管道的缠绕要求最高出纱速度可达 Mm/min，芯模转角分辨率为 0.018 小车轨迹控制误差小于0 毫米，整机响应速度快，性能稳定，操作简单该系统已经应用于大庆竹田复合材料有限公司，实践证明该系统对提高玻璃钢管缠绕成型工艺的技术水平、自动化程度和管道质量具有非常重要的作用，并缩短了管道的开发周期，减少了工作人员的劳动强度，提高了生产效率，降低了生产成本武汉若比特机器人有限公司5 / 5
