基于PLC的机械手控制设计(论文)

1、 . . . 基于PLC的机械手控制设计关键词：机械手伺服电机PLC    步进电机随着社会生产不断进步和人们生活节奏不断加快，人们对生产效率也不断提出新要求。由于微电子技术和计算软、硬件技术的迅猛发展和现代控制理论的不断完善，使机械手技术快速发展，其中气动机械手系统由于其介质来源简便以与不污染环境、组件价格低廉、维修方便和系统安全可靠等特点，已渗透到工业领域的各个部门，在工业发展中占有重要地位。本文讲述的气动机械手有气控机械手、XY轴丝杠组、转盘机构、旋转基座等机械部分组成。主要作用是完成机械部件的搬运工作，能放置在各种不同的生产线或物流流水线中，使零件搬运、货

2、物运输更快捷、便利。 一 四轴联动简易机械手的结构与动作过程机械手结构如下图1所示，有气控机械手(1)、XY轴丝杠组(2)、转盘机构(3)、旋转基座(4)等组成。其运动控制方式为：(1)由伺服电机驱动可旋转角度为360°的气控机械手(有光电传感器确定起始0点)；(2)由步进电机驱动丝杠组件使机械手沿X、Y轴移动(有x、y轴限位开关)；(3)可回旋360°的转盘机构能带动机械手 与丝杠组自由旋转(其电气拖动部分由直流电动机、光电编码器、接近开关等组成)；(4)旋转基座主要支撑以上3部分；(5)气控机械手的合由气压控制(充气时机械手抓紧，放气时机械手松开)。其工作过程为：当货物

3、到达时，机械手系统开始动作；步进电机控制开始向下运动，同时另一路步进电机控制横轴开始向前运动；伺服电机驱动机械手旋转到达正好抓取货物的方位处，然后充气，机械手夹住货物。步进电机驱动纵轴上升，另一个步进电机驱动横轴开始向前走；转盘直流电机转动使机械手整体运动，转到货物接收处；步进电机再次驱动纵轴下降，到达指定位置后，气阀放气，机械手松开货物；系统回位准备下一次动作。二 控制器件选型为达到精确控制的目的，根据市场情况，对各种关键器件选型如下：1. 步进电机与其驱动器机械手纵轴(Y轴)和横轴(X轴)选用的是四通电机技术的42BYG250C型两相混合式步进电机，步距角为0.9°/1.8

4、76;，电流1.5A。M1是横轴电机，带动机械手机构伸、缩；M2是纵轴电机，带动机械手机构上升、下降。所选用的步进电机驱动器是SH-20403型，该驱动器采用1040V直流供电，H桥双极恒相电流驱动，最大3A的8种输出电流可选，最大64细分的7种细分模式可选，输入信号光电隔离，标准单脉冲接口，有脱机保持功能，半密闭式机壳可适应更恶劣的工况环境，提供节能的自动半电流方式。驱动器部的开关电源设计，保证了驱动器可适应较宽的电压围，用户可根据各自情况在1040VDC之间选择。一般来说较高的额定电源电压有利于提高电机的高速力矩，但却会加大驱动器的损耗和温升。本驱动器最大输出电流值为3A/相(峰值)，通过

5、驱动器面板上六位拨码开关的第5、6、7三位可组合出8种状态，对应8种输出电流，从0.9A到3A以配合不同的电机使用。本驱动器可提供整步、改善半步、4细分、8细分、16细分、32细分和64细分7种运行模式，利用驱动器面板上六位拨码开关的第1、2、3三位可组合出不同的状态。2. 伺服电机与其驱动器机械手的旋转动作采用松下伺服电机A系列小惯量MSMA5AZA1G，其额定输出50W、100/200V共用，旋转编码器规格为增量式(脉冲数2500p/r、分辨率10000p/r、引出线11线）；有油封，无制动器，轴采用键槽连接。该电机采用松下公司独特算法，使速度频率响应提高2倍，达到500Hz ；定位超调整

6、定时间缩短为以往松下伺服电机产品V系列的1/4。具有共振抑制功能、控制功能、全闭环控制功能，可弥补机械的刚性不足，从而实现高速定位，也可通过外接高精度的光栅尺，构成全闭环控制，进一步提高系统精度。具有常规自动增益调整和实时自动增益调整两种自动增益调整方式，还配有RS-485、RS-232C 通信口，使上位控制器可同时控制多达16个轴。伺服电机驱动器为A系列MSDA5A3A1A，适用于小惯量电动机。3. 直流电机可回旋360°的转盘机构有直流无刷电机带动，系统选用的是和时利公司生产的57BL1010H1无刷直流电机，其调速围宽、低速力矩大、运行平稳、低噪音、效率高。无刷直流电机驱动器使

7、用和时利公司生产的BL-0408驱动器，其采用2448V直流供电，有起停与转向控制、过流、过压与堵转保护，且有故障报警输出、外部模拟量调速、制动快速停机等特点。4. 旋转编码器在可回旋360°的转盘机构上，安装有OMRON公司生产的E6A2增量型旋转编码器，5. PLC的选型根据系统的设计要求，选用OMRON公司生产的CPM2A小型机。CPM2A在一个小巧的单元综合有各种性能，包括同步脉冲控制、中断输入、脉冲输出、模拟量设定和时钟功能等。CPM2A的CPU单元又是一个独立单元，能处理广泛的机械控制应用问题，所以它是在设备用作装控制单元的理想产品。完整的通信功能保证了与个人计算机、其它

8、OMRON PC和OMRON可编程终端的通信。这些通信能力使四轴联动简易机械手能方便的融合到工业控制系统中。三 软件编程1. 软件流程图流程图是PLC程序设计的基础。只有设计出流程图，才可能顺利而便捷地编写出梯形图并写出语句表，最终完成程序的设计。所以写出流程图非常关键也是程序设计首先要做的任务。依据四轴联动简易机械手的控制要求，绘制流程图如图2所示。2. 程序部分由于论文篇幅有限，这里只列出了开始两段程序，供读者参阅，见图3。四 结束语四轴联动简易机械手的各个动作和状态都由PLC控制，不仅能满足机械手的手动、半自动 、自动等操作方式所需的大量按扭、开关、位置检测点的要求，更可通过接口元器件与

9、计算机组成PLC工业局域网，实现网络通信与网络控制。使四轴联动简易机械手能方便地嵌入到工业生产流水线中。机电一体化智能大流量电动执行机构论文摘要提出一种新型电动执行机构的设计方案，详细介绍了该执行机构各功能元件的选型与设计、阀位与速度控制原理以与各种关键问题的解决方法。该执行机构将阀门、伺服电机、控制器合为一体，采用8031单片机、变频技术实现了阀门的动作速度和位置控制，解决了阀门的精确定位、阀门柔性开关、极限位置判断、电机保护与模拟信号隔离等技术问题。现场运行情况表明，该电动执行机构具有动作快、保护完善以与便于和计算机通讯等优点。 1引言 在现代化生产过程控制中，执行机构起着十分重要的作用，

10、它是自动控制系统中不可缺少的组成部分。现有的国产大流量电动执行机构存在着控制手段落后、机械传动机构多、结构复杂、定位精度低、可靠性差等问题。而且执行机构的全程运行速度取决于其电机的输出轴转速和其部减速齿轮的减速比，一旦出厂，这一速度固定不可调整，其通用性较弱。整个机构缺乏完善的保护和故障诊断措施以与必要的通信手段，系统的安全性较差，不便与计算机联网。鉴于以上原因，采用传统的大流量电动执行机构的控制系统，可靠性和稳定性较差。随着计算机网络、现场总线等技术在工业过程中的应用，这种执行机构已远远不能满足工业生产的要求。笔者设计的大流量电动执行机构，采用机电一体化技术，将阀门、伺服电机、控制器合为一体

11、，利用异步电动机直接驱动阀门的开与关。通过置变频器，采用模糊神经网络，实现阀门的动作速度、精确定位、柔性开关以与电机转矩等控制。该电动执行机构省去了用于控制电机正、反转的接触器和可控硅换向开关模件、机械传动装置和复杂、昂贵的控制柜和配电柜，具有动作快、保护较完善、便于和计算机联网等优点。实际运行表明，该执行机构工作稳定，性能可靠。 2电动执行机构的硬件设计与工作原理 电动执行机构控制系统原理框图如图2-1所示。智能执行机构从结构上主要分为控制部分和执行驱动部分。 控制部分主要由单片机、PWM波发生器、IPM逆变器、A/D、D/A转换模块、整流模块、输入输出通道、故障检测和报警电路等组成。执行驱

12、动部分主要包括三相伺报电机和位置传感器。 系统工作原理： 霍尔电流、电压传感器与位置传感器检测到的逆变模块三相输出电流、电压与阀门的位置信号，经A/D转换后送入单片机。单片机通过8255控制PWM波发生器，产生的PWM波经光电耦合作用于逆变模块IPM，实现电机的变频调速以与阀位控制。逆变模块工作时所需要的直流电压信号由整流电路对380V电源进行全桥整流得到。 控制系统各功能元件的选型与设计： 1)单片机选用INTEL公司生产的8031单片机，它主要通过并行8255口担负控制系统的信号处理：接收系统对转矩、阀门开启、关闭与阀门开度等设定信号，并提供三相PWM波发生器所需要的控制信号；处理IPM发

13、出的故障信号和报警信号；处理通过模拟输入口接收的电流、电压、位置等检测信号；提供显示电动执行机构的工作状态信号；执行控制系统来的控制信号，向控制系统反馈信号； 2)三相PWM波发生器PWM波的产生通常有模拟和数字两种方法。模拟法电路复杂，有温漂现象，精度低，限制了系统的性能；数字法是按照不同的数字模型用计算机算出各切换点，并存入存，然后通过查表与必要的计算产生PWM波，这种方法占用的存较大，不能保证系统的精度。为了满足智能功率模块所需要的PWM波控制信号，保证微处理器有足够的时间进行整个系统的检测、保护、控制等功能，文中选用MITEL公司生产的SA8282作为三相PWM发生器。SA8282是专

14、用大规模集成电路，具有独立的标准微处理器接口，芯片部包含了波形、频率、幅值等控制信息。 3)智能逆变模块IPM为了满足执行机构体积小，可靠性高的要求，电机电源采用智能功率模块IPM。该执行机构主要适用功率小于55kW的三相异步电机，其额定电压为380V，功率因数为075。经计算可知，选用日本产的智能功率模块PM50RSA120可以满足系统要求。该功率模块集功率开关和驱动电路、制动电路于一体，并置过电流、短路、欠电压和过热保护以与报警输出，是一种高性能的功率开关器件。 4)位置检测电路位置检测电路是执行机构的重要组成部分，它的功能是提供准确的位置信号。关键问题是位置传感器的选型。在传统的电动执行

15、机构中多采用绕线电位器、差动变压器、导电塑料电位器等。绕线电位器寿命短被淘汰。差动变压器由于线性区太短和温度特性不理想而受到限制。导电塑料电位器目前较为流行，但它是有触点的，寿命也不可能很长，精度也不高。笔者采用的位置传感器为脉冲数字式传感器，这种传感器是无触点的，且具有精度高、无线性区限制、稳定性高、无温度限制等特点。 5)电压、电流与检测检测电压、电流主要是为了计算电机的力矩，以与变频器输出回路短路、断相保护和逆变模块故障诊断。由于变频器输出的电流和电压的频率围为050Hz，采用常规的电流、电压互感器无法满足要求。为了快速反映出电流的大小，采用霍尔型电流互感器检测IPM输出的三相电流，对于

16、IPM输出电压的检测采用分压电路。如图2-2所示。 6)通讯接口为了实现计算机联网和远程控制，选用MAX232作为系统的串行通讯接口，MAX232部有两个完全一样的电平转换电路，可以把8031串行口输出的TTL电平转换为RS232标准电平，把其它微机送来的RS232标准电平转换成TTL电平给8031，实现单片机与其它微机间的通讯。 7)时钟电路时钟电路主要用来提供采样与控制周期、速度计算时所需要的时间以与日历。文中选用时钟电路DS12887。DS12887部有114字节的用户非易失性RAM，可用来存入需长期保存的数据。 8)液晶显示单元为了实现人机对话功能，选用MGLS12832液晶显示模块组

17、成显示电路。采用组态显示方式。通过菜单选择，可分别对阀门、力矩、限位、电机、通讯和参数等信号进行设置或调试。并采用文字和图形相结合的方式，显示直观、清晰。 9)程序出格自恢复电路为了保证在强干扰下程序出格时系统能够自动地恢复正常，选用MAX705组成程序出格自恢复电路，监视程序运行。如图2-3所示，该电路由MAX705、与非门与微分电路组成。 工作原理为：一旦程序出格，WDO由高变低，由于微分电路的作用，由“与非”门输入引脚2变为高电平，引脚2电平的这种变化使“与非”门输出一个正脉冲，使单片机产生一次复位，复位结束后，又由程序通过P10口向MAX705的WDI引脚发正脉冲，使WDO引脚回到高电

18、平，程序出格自恢复电路继续监视程序运行。3阀位与速度控制原理 阀位与速度控制原理框图如图3-1所示。 采用双环控制方案，其中环为速度环，外环为位置环。速度环主要将当前速度与速度给定发生器送来的设定速度相比较，通过速度调节器改变PWM波发生器载波频率，实现电机的转速调节。速度调节器采用模糊神经网络控制算法(具体容另文叙述)。 外环主要根据当前位置速度的设定，通过速度给定发生器向环提供速度的设定值。由于大流量阀执行机构在运行过程中存在加速、匀速、减速等阶段。各阶段的时间长短、加速度的大小、在何位置开始匀速或减速均与给定位置、当前位置以与运行速度有关。速度给定发生器的工作原理为：通过比较实际阀位与给

19、定阀位，当二者不相等时，以恒定加速度加速，减速点根据当前速度、阀位值、阀位给定值的大小计算得来。 执行机构各阶段运行速度的计算原理 图3-2为执行机构的典型运行速度图，它由若干段变化速率不同的折线组成。将曲线上速率开始发生改变的那一点称为起始段点，相应的时间称为段起始时间，如图3-2中的t(i)(i0，1，2，)，相应的速度称为段起始速度，如图3-2所示v(i)(i0，1，2，)。 设第i段速度的变化速率为ki，则有： 式中：v为两段点之间的速度变化值，vvi1vi； t为两段之间的时间，tti1ti。 显然，当ki0时为恒速段，ki0时为升速段，ki0时为减速段。任意时刻的速度给定值为： T

20、s为采样周期。 变化速率ki的取值由给定位置、当前位置以与运行速度的大小确定。 4关键技术问题的解决 该电动执行机构采用了最新的变频调速技术，电机驱动功率小于55kW。用户可根据需要设定力矩特性，根据控制的阀设定速度，速度分多转式、直行程、角行程3种方式。控制系统由阀位给定和阀位反馈信号构成的闭环系统，控制特性视运行方式、速度而定，并具有自动过流保护、过载保护、超压、欠压、过热、缺相、堵转等保护功能。 该执行机构解决的关键性技术问题主要有： 1)阀门柔性开关柔性开关主要是为了当阀关闭或全开时，保证阀门不卡死与损伤。执行机构部的微处理器根据测得的变频器输出电压和电流，通过精确计算，得出其输出力矩

21、。一旦输出力矩达到或大于设定的力矩，自动降低速度，以避免阀门部过度的撞击，从而达到最优关闭，实现过力矩保护。 2)阀位的极限位置判断阀位的极限位置是指全开和全关位置。在传统执行机构中，该位置的检测是通过机械式限位开关获得的。机械式限位开关精度低，在运行中易松动，可靠性差。在文中，电动执行机构极限位置通过检测位置信号的增量获得。其原理是，单片机将本次检测的位置信号与上次检测的信号相比较，如果未发生变化或变化较小，即认为己达到极限位置，立即切断异步电机的供电电源，保证阀门的安全关闭或全开。省去了机械式限位开关，无需在调试时对其进行复杂的调整。 3)电机保护的实现为了防止电机因过热而烧毁，单片机通过

22、温度传感器连续检测电机的实际运行温度，如果温度传感器检测到电机温度过高，自动切断供电电源。温度传感器置于电机部。 4)准确定位传统的电动执行机构在异步电机通电后会很快达到其额定动作速度，当接近停止位置时，电机断电后，由于机械惯性，其阀门不可能立即停下来，会出现不同程度的超程，这一超程通常采用控制电机反向转动来校正。机电一体化的大流量电动执行机构根据当前位置与给定位置的差值以与运行速度的大小超前确定减速点的位置与减速段变化速率ki，使阀门在较低的速度下实现精确的微调和定位，从而将超程降到最低。 5)模拟信号的隔离。 对于变频器的直流电压以与输出的三相电压，它们之间的地址不一致，存在着较高的共模电压，为了保证系统的安全性，必须将它们彼此相互隔离。采用LM358和4N25组成了隔离线性放大电路。如图4-1所示，采用±15V和±12V两组独立的正负电源