PLC机械手控制要点.docx

1、PLC机械手控制要点1 引言 本文以某物流控制中机械手控制为例，分析了PLC和步进驱动装置控制方法，本系统涉及主要硬件是S7-200 PLC和SH-2H057步进驱动器。(1) S7-200 PLC系列是西门子公司可编程控制器,这一系列产品可以满足多种多样自动化控制要求，由于具有紧凑设计、良好扩展性、低廉价格以及强大指令，使得S7-200 PLC可以满足小规模控制要求。此外，丰富CPU类型和电压等级使其在解决用户工业自动化问题时，具有很强是适用性。1台S7-200 PLC包括一个单独S7-200 CPU，或者带有各种各样可选扩展模块。S7-200 CPU模块包括一个中央处理单元(CPU)、电源

2、以及数字量I/O点，这些都被集成在一个紧凑、独立设备中。l CPU负责执行程序和存储数据，以便对工业自动化控制任务或过程进行控制;l 输入和输出是系统控制点:输入部分从现场设备中采集信号，输出部分则控制泵、电机、以及控也过程中其他设备;l 电源向CPU 及其所连接任何设备提供电力;l 通讯端口允许将S7-200 CPU同编程器或其他一些设备连起来;l 状态信号灯显示了CPU 工作模式(运行或停止)，本机I/O当前状态，以及检查出来系统错误;l 通过扩展模块可提供其通讯性能;l 通过扩展模块可增加CPUI/O点数(CPU 221不扩展);l 一些CPU有内置实时时钟，或添加实时时钟卡;l EEP

3、ROM卡可以存储CPU程序，也可以将一个CPU中程序送到另一个CPU中;l 通过可选插入式电池盒可延长RAM中数据存储时间;l 最大I/O配置。( 2) SH-2H057驱动器输入信号共有三路，他们是:步进脉冲信号CP、方向电平信号DIR、脱机电平信号FREE.他们在驱动器内部分别通过270限流电阻接入光耦负输入端，且电路形式完全相同，三路光耦正输入端为OPTO端，三路输入信号在驱动器内部接成共阳方式，所以OPTO端需接外部系统VCC端，如果VCC是+5伏，可直接接入;否则需在外部另加限流电阻，保证给驱动器内部光耦提供8-15mA驱动电流。l 步进脉冲信号CP 步进脉冲信号CP用于控制步进电机

4、位置和速度，也就是说:驱动器每接受一个CP脉冲就驱动步进电机旋转一个步角度，CP脉冲频率改变则同时是步进电机速率改变，控制CP脉冲个数，则可以使步进电机精确定位。这样就可以很方便达到步进电机调速和定位目。本驱动器CP信号为低电平有效，要求CP信号驱动电流为8-15mA，对CP脉冲宽度也有一定要求，一般不小于5s。l 方向电平信号DIR 方向电平信号DIR用于控制步进电机旋转方向。此端为高电平时，电机为一个转向;次端为低电平时，电机为另一个转向。电机换向必须在电机停止后再进行，并且换向信号一定要在前一个方向最后一个CP脉冲结束后以及下一个方向第一个CP脉冲前发出。l 脱机电平信号FREE当驱动器

5、上电后，步进电机处于锁定状态(未施加CP脉冲时)或运行状态(施加CP脉冲)，但用户想手动调整电机而又不想关闭驱动器电源，这时可以用到此信号，此信号低电平有效，电机处于自由无力矩状态;当此信号为高电平或悬空不接时，取消脱机状态。l 步进电机简介 SH-2H057型驱动器用于驱动二相或四相混合式步进电机(亦称感应子式)，此驱动器一般驱动60号机座以下电机。电机出线方式不同，和驱动器连接也不同。本系统使用电机为二相四根线电机，可以直接和驱动器相连。见图1机械手电机驱动模块原理图。2系统工作工程 本系统机械手部分由底盘、立杆、手臂、手组成，其中底盘由一个步进电机驱动，可顺逆时针旋转;立杆由一个步进电机

6、驱动，可上下移动;手臂由一个步进电机驱动，可前后伸缩;手由气泵控制，可抓紧和放松。在相应位置都有位置检测信号用于定位。参见图1。(1) 出货过程 从复位位置启动,根据要求到相应出货台(1，2，3号货台),此时底盘转动到要求位置，立柱下降,手臂伸出,定位后手抓货物,立柱上升,同时手臂回收(以免运行中和其它设备相撞),然后到相应出货台(左,或右出货台),立柱下降,手臂伸出,手打开,把货物放在相应出货台上。(2) 进货过程 从复位位置启动,根据要求到相应出货台(左，或右出货台),此时底盘转动到要求位置，立柱下降,手臂伸出,定位后手抓货物,立柱上升,同时手臂回收(以免运行中和其它设备相撞),然后到相应

7、出货台(1，2，3号货台),立柱下降,手臂伸出,手打开,把货物放在相应出货台上。 3 系统设计思想 步进控制电路设计思想，PLC继电器式输出模块工作速度较低，故采用高频脉冲方波发生器，给出步进脉冲，其振荡频率按步进电机速度设置，步进量控制采用位置检测，根据位置检测信号用PLC输出点切断进给电机，实现步进电机停车, 其程序流程图如图2所示。 在整个机械手运行控制过程中，采用限位开关以及面板操作开关以及系统逻辑开关作为输入点，整个系统中底盘有5个限位开关，分别作为5个位置定位输入点，立柱有4个限位开关，分别为1个复位开关、一号位限位输入量、上限位、下限位。手臂有3个限位开关:手臂复位限位数入点、手

8、臂前限位、手臂后限位。抓手限位开关，为抓手复位输入点。一共13个限位开关完成全部控制输入。各限位开关分布情况见图1， 由于在整个控制过程中全部是通过控制步进电机驱动模块再驱动步进电机执行。这里对用集成脉冲输出触发步进电机驱动器原理进行说明。S7-200 PLC(CPU 226)Q0.0和Q0.1分别对升/降步进电机、前/后步进电机发送脉冲;CPU 226Q0.2对转盘步进电机发送脉冲。而步进电机正/反转则分别是CPU 226Q0.4和Q0.5分别对升/降步进电机、前/后步进电机实行控制;CPU 226 Q0.6和Q0.7分别对转盘步进电机正反、抓手气泵开关实行控制。 机械手PLC程序设计编写采

9、用了STEP 7-Micro/WIN32软件数据表(STL)形式。程序设计修改方便，设计完成可联机调试，没有问题再把步进电机接上。 上位机监控软件采用北京亚控组态王软件，通过变量映射实现组态软件变量和PLC寄存器动态连接，从而实现了上位机对PLC监控。4 结束语 本机械手控制系统结构紧凑，动作可靠，使用方便，已较好地应用于我校科研教学中.随着社会生产不断进步和人们生活节奏不断加快，人们对生产效率也不断提出新要求。由于微电子技术和计算软、硬件技术迅猛发展和现代控制理论不断完善，使机械手技术快速发展，其中气动机械手系统由于其介质来源简便以及不污染环境、组件价格低廉、维修方便和系统安全可靠等特点，已

10、渗透到工业领域各个部门，在工业发展中占有重要地位。本文讲述气动机械手有气控机械手、XY轴丝杠组、转盘机构、旋转基座等机械部分组成。主要作用是完成机械部件搬运工作，能放置在各种不同生产线或物流流水线中，使零件搬运、货物运输更快捷、便利。一、四轴联动简易机械手结构及动作过程机械手结构如下图1所示，有气控机械手(1)、XY轴丝杠组(2)、转盘机构(3)、旋转基座(4)等组成。 其运动控制方式为：(1)由伺服电机驱动可旋转角度为360气控机械手(有光电传感器确定起始0点)；(2)由步进电机驱动丝杠组件使机械手沿X、Y轴移动(有x、y轴限位开关)；(3)可回旋360转盘机构能带动机械手及丝杠组自由旋转(

11、其电气拖动部分由直流电动机、光电编码器、接近开关等组成)；(4)旋转基座主要支撑以上3部分；(5)气控机械手张合由气压控制(充气时机械手抓紧，放气时机械手松开)。其工作过程为：当货物到达时，机械手系统开始动作；步进电机控制开始向下运动，同时另一路步进电机控制横轴开始向前运动；伺服电机驱动机械手旋转到达正好抓取货物方位处，然后充气，机械手夹住货物。步进电机驱动纵轴上升，另一个步进电机驱动横轴开始向前走；转盘直流电机转动使机械手整体运动，转到货物接收处；步进电机再次驱动纵轴下降，到达指定位置后，气阀放气，机械手松开货物；系统回位准备下一次动作。二、控制器件选型为达到精确控制目，根据市场情况，对各种

12、关键器件选型如下：1.步进电机及其驱动器机械手纵轴(Y轴)和横轴(X轴)选用是北京四通电机技术有限公司42BYG250C型两相混合式步进电机，步距角为0.9/1.8，电流1.5A。M1是横轴电机，带动机械手机构伸、缩；M2是纵轴电机，带动机械手机构上升、下降。所选用步进电机驱动器是SH-20403型，该驱动器采用1040V直流供电，H桥双极恒相电流驱动，最大3A8种输出电流可选，最大64细分7种细分模式可选，输入信号光电隔离，标准单脉冲接口，有脱机保持功能，半密闭式机壳可适应更恶劣工况环境，提供节能自动半电流方式。驱动器内部开关电源设计，保证了驱动器可适应较宽电压范围，用户可根据各自情况在10

13、40VDC之间选择。一般来说较高额定电源电压有利于提高电机高速力矩，但却会加大驱动器损耗和温升。本驱动器最大输出电流值为3A/相(峰值)，通过驱动器面板上六位拨码开关第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、

14、引出线11线)；有油封，无制动器，轴采用键槽连接。该电机采用松下公司独特算法，使速度频率响应提高2倍，达到500Hz；定位超调整定时间缩短为以往松下伺服电机产品V系列1/4。具有共振抑制功能、控制功能、全闭环控制功能，可弥补机械刚性不足，从而实现高速定位，也可通过外接高精度光栅尺，构成全闭环控制，进一步提高系统精度。具有常规自动增益调整和实时自动增益调整两种自动增益调整方式，还配有RS-485、RS-232C通信口，使上位控制器可同时控制多达16个轴。伺服电机驱动器为A系列MSDA5A3A1A，适用于小惯量电动机。3.直流电机可回旋360转盘机构有直流无刷电机带动，系统选用是北京和时利公司生产

15、57BL1010H1无刷直流电机，其调速范围宽、低速力矩大、运行平稳、低噪音、效率高。无刷直流电机驱动器使用北京和时利公司生产BL-0408驱动器，其采用2448V直流供电，有起停及转向控制、过流、过压及堵转保护，且有故障报警输出、外部模拟量调速、制动快速停机等特点。4.旋转编码器在可回旋360转盘机构上，安装有OMRON公司生产E6A2增量型旋转编码器，编码器将信号传给PLC，实现转盘机构精确定位。5. PLC选型根据系统设计要求，选用OMRON公司生产CPM2A小型机。CPM2A在一个小巧单元内综合有各种性能，包括同步脉冲控制、中断输入、脉冲输出、模拟量设定和时钟功能等。CPM2ACPU单

16、元又是一个独立单元，能处理广泛机械控制应用问题，所以它是在设备内用作内装控制单元理想产品。完整通信功能保证了和个人计算机、其它OMRON PC和OMRON可编程终端通信。这些通信能力使四轴联动简易机械手能方便融合到工业控制系统中。三、软件编程1.软件流程图流程图是PLC程序设计基础。只有设计出流程图，才可能顺利而便捷地编写出梯形图并写出语句表，最终完成程序设计。所以写出流程图非常关键也是程序设计首先要做任务。依据四轴联动简易机械手控制要求，绘制流程图如图2所示。2.程序部分由于论文篇幅有限，这里只列出了开始两段程序，供读者参阅，见图3。四、结束语四轴联动简易机械手各个动作和状态都由PLC控制，不仅能满足机械手手动、半自动、自动等操作方式所需大量按扭、开关、位置检测点要求，更可通过接口元器件和计算机组成PLC工业局域网，实现网络通信和网络控制。使四轴联动简易机械手能方便地嵌入到工业生产流水线中。