基于PLC的四自由度电动机械手的控制设计

1、基于PLC的四自由度电动机械手的控制设计 摘 要：所介绍的电动机械手由电控机械手、yz轴丝杠组、手转动机构、旋转底盘等机械部分组成，在PLC控制下，它可在行程范围内将物体从一点搬运至另一任意点，可置放于各种不同生产线或物流流水线中。关键词：机械手；PLC；步进电机中图分类号：TP241 文献标志码：A 文章编号：Design of the Control System of 4-dimension Motor-driven Mechanical Manipulator Based on PLCAbstract: Motor-driven mechanical manipulator dissc

2、ussed in this paper consists of power-operated mechanical manipulator,y-axis and z-axis screw lever modules ,rotatry mechanism of manipulator,rotated-plate at the bottom etc. On the control of PLC system,it can take bodies from one place to another in the range of its journey. It can be placed on di

3、fferent manufacture assembly lines or goods circulation lines. Key Words:mechanical manipulator; PLC; step motor随着微电子技术、计算机和现代控制理论的不断完善，机械手技术也快速发展。按实现功能和驱动方式划分，机械手可以分为很多种。仅就驱动方式，就有气动（或液动）、电动和电气混合等。为实现不同的功能，有3个自由度的，也有4、5个自由度的，甚至还有6个自由度的。本文中，笔者仅论述基于PLC技术的4个自由度电动机械手的控制设计，它能满足绝大多数场合的搬运需要，并且可用于教学实验，具有良好的

4、示范性和教学性。1 4轴联动简易机械手的结构及动作过程如图1所示，搬运一个零件，一般需要4个自由度确定其位置：3个坐标确定其空间位置；1个角度坐标确定其摆放方位。本文中确定空间位置的3个坐标分别是角度A、Y轴坐标Y1和Z轴坐标Z1；摆放方位（方位角）由零件长度方向的轴线与X轴形成的夹角B确定。通常情况下，4个自由度的机械手即可满足大多数搬运需求。4个自由度电动机械手的结构如图2所示。它由电磁铁控制的机械手1、YZ轴丝杠组2、手转动机构3、旋转底盘4、物料输送带5、PLC 6、控制面板7、步进电机驱动器8和24V电源9等组成。图1 确定物体位置的一般坐标985764132图2 电动机械手结构其运

5、动控制方式为：1)由步进电机驱动可旋转角度为90的电控机械手，由微动开关确定其起始0点；2)由步进电机驱动丝杠组件，使机械手沿Y和Z轴移动，有Y、Z轴接近开关作安全限位；3)可回旋270的旋转机构能带动机械手及丝杠组自由旋转，其电气拖动部分由步进电机、微动开关等组成；4)旋转底盘主要支撑以上3部分；5)电控机械手的张合由电磁铁控制，通电时机械手抓紧，断电时机械手松开。其工作流程如下：1）当被搬运物体到达预定位置时，通过光电开关发出信号，机械手系统开始动作；3台步进电机分别控制旋转运动、横向运动和上下运动，手转动机构驱动机械手旋转一个方位角，然后电磁铁通电，机械手夹住物体。2）步进电机驱动纵轴上

6、升，另一个步进电机驱动横轴开始向前走动；转盘步进电机转动使机械手整体运动，转到物体接收处。3）步进电机再次驱动纵轴下降（或上升），到达指定位置后，电磁铁断电，机械手松开物体。4）系统回位，准备下一次动作。2 控制器件选型为使控制较为精确，对各种关键器件的类型应有所选择。2 1 步进电机及其驱动器控制面板负载步进电机是将电脉冲信号转变为角位移或线位移的开环控制元件。在非超载情况下，电机的转速及停止位置只取决于脉冲信号的频率和脉冲数，而不受负载变化的影响。即给电机加一个脉冲信号，电机就转过一个步距角。虽然步进电机已被广泛应用，但步进电机并不能像普通的直流电机和交流电机一样在常规下使用，它必须由双环

7、形脉冲信号、功率驱动电路等组成控制系统方可使用1（见图4）。选择电机一般应遵循图3所示的步骤2。步距角PLC 静转矩修正驱动器电流步进电机矩频特性曲线负载电机型号 图3 步进电机选择步骤 图4 控制系统结构框图本文中的机械手主要用于教学，故所需精度不很高，力矩也不要太大。纵轴(Z轴)、横轴(Y轴)和手转动电机选用的是广州瑞宝公司的17HD0005-18型两相混合式步进电机，步距角为1.8，电流DC 0.28 A/相，最大静力矩16010-3Nm。 旋转底座选用23HD0020-25型步进电机，步距角为1.8，电流DC 0.6 A/相，最大静力矩33010-3Nm。所选用的步进电机驱动器是RB2

8、304ME型细分驱动器，驱动电压为DC1240 V，采用双极恒流斩波方式，可减少电机噪音。输出电流从03A/相连续可调。设有12/8档等角恒力矩细分，最大200细分。输入信号光电隔离，标准单脉冲接口，有脱机保持功能，半密闭式机壳可适应更恶劣的工况环境，提供节能的自动半电流方式，减少电机发热。2.2 电磁铁系统中电磁铁的作用是利用电磁吸引力操纵机械手以完成预期动作。应根据负载的要求选择电磁铁的种类和结构形式，然后根据控制系统的电压选择电磁铁的线圈电压。电磁铁的功率应不小于制动或牵引功率。本文中的机械手选用DC 24 V直流电磁铁。2.3 PLC的选型根据系统的设计要求，选用三菱公司生产的FX2C

9、-64MT型PLC机。FX2C-64MT虽然小巧,但其内综合有各种性能，包括同步脉冲控制、中断输入、脉冲输出、数据处理、模拟量设定和时钟功能等，能广泛处理机械控制应用问题。它完整的通信功能保证了与个人计算机、其它FX 系列PLC和FX可编程终端的通信。这些通信能力使4轴联动简易机械手能方便的融合到工业控制系统中。为了节省成本，不另外选用PLC的专用运动控制模块，而是直接利用PLC的高速脉冲输出功能（PLSY指令）。由于本系统选用晶体管输出型的PLC，为避免晶体管不能可靠关断导致机械手动作失灵，故用PLC的一个输出点控制继电器，再由它控制电磁铁的得失电。3、软件编程31 输入和输出点分配表表1

10、机械手传送系统输入和输出点分配表名 称代号I/O点名 称代号I/O点名 称代号I/O点启动手动操作连续操作旋转左位旋转右位上限行程下限行程左限行程右限行程转动左位转动右位输入位置电源指示启动指示连续操作指示手动操作指示抓手转动指示SB1SB3SB4SQ1SQ2SQ3SQ4SQ5SQ6SQ7SQ8SB16HD2HD3HD4HD5HD10X0X1X2X3X4X5X6X7X10X11X12X30Y16Y17Y20Y21Y26停止回原点工件检测单步左旋单步右旋单步上升单步下降单步左移单步右移单步左转单步右转电磁铁抓工件检测指示旋转电机指示升降电机指示水平电机指示电磁铁抓指示传送带电机SB2SB5B1S

11、B6SB7SB8SB9SB10SB11SB12SB13SB14HD6HD7HD8HD9HD11M5X13X14X15X16X17X20X21X22X23X24X25X26Y22Y23Y24Y25Y27Y37Z轴步进电机脉冲Z轴步进电机方向Y轴步进电机脉冲Y轴步进电机方向旋转步进电机脉冲旋转步进电机方向转动步进电机脉冲转动步进电机方向回原点指示灯电磁铁M1 PM1 DM2 PM2 DM3 PM3 DM4 PM4 DHD1YV1Y0Y2Y1Y3Y4Y6Y5Y7Y10Y11有了输入输出点分配表，PLC接线原理图就很容易画出，如图5所示。图5 PLC接线原理图32 操作系统 操作系统包括回原点程序、手

12、动单步操作程序和自动连续操作程序，如图6所示。图6 机械手操作系统程序其原理是：将把回原点按钮按下，X14接通，系统自动回原点，Y10驱动指示灯亮。再将旋钮置于手动，则X1接通，其常闭触头打开，程序不跳转（CJ为一跳转指令，如果CJ驱动，则跳到指针P所指P0处），执行手动程序。之后，由于X2处于常闭位，当执行CJ指令时，跳转到P1所指的结束位置。如果旋钮置于自动位置（即X1常闭闭合、X2常闭打开），则程序执行时跳过手动程序，直接执行自动程序。33 自动连续操作流程图如前所述，机械手操作系统程序有3个基本程序段。因篇幅所限，这里仅给出自动连续操作流程图。操作流程图是PLC程序设计的基础、关键和首

13、要任务，只有设计出流程图，才能顺利而便捷地编写出梯形图并写出语句表，最终完成程序的设计。依据4轴联动简易机械手的控制要求，绘制流程图如图7所示。开始输入位置参数机械手回位工件在否机械手放开机械手开始动作转动、移动到要求位置旋转、Y、Z轴向移动机械手抓取手到位图7 自动连续操作流程图程序开始时，输入2个位置的参数：工件起始点的A1角、Y1、Z1坐标和摆放方位角B1，工件要求放置点的A2角、Y2、Z2坐标和摆放方位角B2。由PLC进行计算，给出移动到位置1和2所需的4个步进电机的脉冲数（在脉冲频率一定时对应相应的时间）。利用PLC的有关辅助继电器或PLSY指令产生固定频率的脉冲，由若干定时器的定时长短控制脉冲数。方向信号可根据程序流程的次序而产生。在手动操作时，脉冲数由按下操作按钮的时间而决定。4、结束语4轴联动简易机械手的各个动作和状态都由PLC控制，它不仅能满足机械手手动和自动等操作方式所需的大量按扭、开关、位置检测点的要求，还可通过接口元器件与计算机组成PLC工业局域网，实现网络通信