PLC对搬运机械手的控制 -机械动力-毕业论文

---文档均为word文档，下载后可直接编辑使用亦可打印---

摘要

随着现代工业技术的发展，工业自动化技术越来越高，生产工况也有趋于恶劣的态势，这对一线工人的操作技能也提出了更高的要求，同时操作工人的工作安全也受到了相应的威胁。工业机械手是近几十年发展起来的一种高科技自动化生产设备。工业机械手是工业机器人的一个重要分支。它的特点是可通过编程来完成各种预期的作业任务，在构造和性能上兼有人和机器各自的优点，尤其体现了人的智能和适应性。机械手作业的准确性和各种环境中完成作业的能力，在国民经济各领域有着广阔的发展前景。

本课题拟开发物料搬运机械手，采用日本三菱公司的FX2N系列PLC，对机械手的上下、左右以及抓取运动进行控制。该装置机械部分有滚珠丝杠、滑轨、机械抓手等；电气方面由交流电机、变频器、操作台等部件组成。我们利用可编程技术，结合相应的硬件装置，控制机械手完成各种动作。

关键词:可编程序控制器PLC、机械手、步进电机

目录

一、机械手简介

（一）概述

工业机械手由操作机(机械本体)、控制器、伺服驱动系统和检测传感装置构成，是一种仿人操作，自动控制、可重复编程、能在三维空间完成各种作业的机电一体化自动化生产设备。特别适合于多品种、变批量的柔性生产。它对稳定、提高产品质量，提高生产效率，改善劳动条件和产品的快速更新换代起着十分重要的作用。

机械手是模仿着人手的部分动作，按给定程序、轨迹和要求实现自动抓取、搬运或操作的自动机械装置。在工业生产中应用的机械手被称为“工业机械手”。生产中应用机械手可以提高生产的自动化水平和劳动生产率:可以减轻劳动强度、保证产品质量、实现安全生产;尤其在高温、高压、低温、低压、粉尘、易爆、有毒气体和放射性等恶劣的环境中，它代替人进行正常的工作，意义更为重大。因此，在机械加工、冲压、铸、锻、焊接、热处理、电镀、喷漆、装配以及轻工业、交通运输业等方面得到越来越广泛的引用.

机械手的结构形式开始比较简单，专用性较强，仅为某台机床的上下料装置，是附属于该机床的专用机械手。

（二）机械手的组成

机械手主要由执行机构、驱动系统、控制系统以及位置检测装置等所组成。各系统相互之间的关系如方框图2-1所示。

图1-1机械手的组成方框图

(一)执行机构

包括手部、手腕、手臂和立柱等部件，有的还增设行走机构。

1、手部

即与物件接触的部件。由于与物件接触的形式不同，可分为夹持式和吸附式手部。

夹持式手部由手指(或手爪)和传力机构所构成。手指是与物件直接接触的构件，常用的手指运动形式有回转型和平移型。回转型手指结构简单，制造容易，故应用较广泛。平移型应用较少，其原因是结构比较复杂，但平移型手指夹持圆形零件时，工件直径变化不影响其轴心的位置，因此适宜夹持直径变化范围大的工件。

而传力机构则通过手指产生夹紧力来完成夹放物件的任务。传力机构型式较多，常用的有:滑槽杠杆式、连杆杠杆式、斜面杠杆式、齿轮齿条式、丝杠螺母弹簧式和重力式等。

吸附式手部主要由吸盘等构成，它是靠吸附力(如吸盘内形成负压或产生电磁力)吸附物件，相应的吸附式手部有负压吸盘和电磁盘两类。

对于轻小片状零件、光滑薄板材料等，通常用负压吸盘吸料。造成负压的方式有气流负压式和真空泵式。

2、手腕

是连接手部和手臂的部件，并可用来调整被抓取物件的方位(即姿势)。

3、手臂

手臂是支承被抓物件、手部、手腕的重要部件。手臂的作用是带动手指去抓取物件，并按预定要求将其搬运到指定的位置.

工业机械手的手臂通常由驱动手臂运动的部件(如油缸、气缸、齿轮齿条机构、连杆机构、螺旋机构和凸轮机构等)与驱动源(如液压、气压或电机等)相配合，以实现手臂的各种运动。

手臂可能实现的运动如下:

手臂在进行伸缩或升降运动时，为了防止绕其轴线的转动，都需要有导向装置，以保证手指按正确方向运动。此外，导向装置还能承担手臂所受的弯曲力矩和扭转力矩以及手臂回转运动时在启动、制动瞬间产生的惯性力矩，使运动部件受力状态简单。

导向装置结构形式，常用的有:单圆柱、双圆柱、四圆柱和V形槽、燕尾槽等导向型式。

4、立柱

立柱是支承手臂的部件，立柱也可以是手臂的一部分，手臂的回转运动和升降(或俯仰)运动均与立柱有密切的联系。机械手的立往通常为固定不动的，但因工作需要，有时也可作横向移动，即称为可移式立柱。

5、行走机构

当工业机械手需要完成较远距离的操作，或扩大使用范围时，可在机座上安装滚轮、轨道等行走机构，以实现工业机械手的整机运动。滚滚轮轮式式布行走机构可分为有轨的和无轨的两种。驱动滚轮运动则应另外增设机械传动装置。

6、机座

机座是机械手的基础部分，机械手执行机构的各部件和驱动系统均安装于机座上，故起支撑和连接的作用。

(二)驱动系统

驱动系统是驱动工业机械手执行机构运动的动力装置，通常由动力源、控制调节装置和辅助装置组成。常用的驱动系统有液压传动、气压传动、电力传动和机械传动。(三)控制系统

控制系统是支配着工业机械手按规定的要求运动的系统。目前工业机械手的控制系统一般由程序控制系统和电气定位(或机械挡块定位)系统组成

控制系统有电气控制和射流控制两种，它支配着机械手按规定的程序运动，并记忆人们给予机械手的指令信息(如动作顺序、运动轨迹、运动速度及时间)，同时按其控制系统的信息对执行机构发出指令，必要时可对机械手的动作进行监视，当动作有错误或发生故障时即发出报警信号。

(四)位置检测装置

控制机械手执行机构的运动位置，并随时将执行机构的实际位置反馈给控制

系统，并与设定的位置进行比较，然后通过控制系统进行调整，从而使执行机构

以一定的精度达到设定位置。

二、机械手的控制方案与选择

（一）控制要求

如下图所示为某生产车间中自动化搬运机械手，用于将左工作台上的工件搬运到右工作台上。机械手的全部动作由液压驱动。液压泵由电磁阀控制，其上升/下降、左移/右移运动由双线圈两位电磁阀控制，即上升电磁阀得电时机械手上升，下降电磁阀得电时机械手下降。夹紧/放松运动由单线圈两位电磁阀控制，线圈得电时机械手夹紧，断电时机械手放松。

图2-1机械手的动作示意图

为便于控制系统调试和维护，本控制系统应有手动功能和显示功能。当手动/自动转换开关置于“手动”位置时，按下相应的手动按钮，就可实现上升、下降、左移、右移、夹紧、放松的手动控制。当机械手处于原位时，将手动/自动转换开关置于“自动”位置时，进入自动工作状态，手动按钮无效。

（二）机械手的控制系统设计方案的比较

在工业自动化生产中常用的控制系统有：传统的继电器—接触器控制系统、PLC控制系统和微机控制系统这三种。但从使用性、经济性、可靠性出发，本设计选用了PLC。因为从上述该机械手所需完成的控制动作分析来看，本机械手是用于各种传感器在复杂的条件下工件的传输，主要动作是上升、下降、左移、右移、夹紧、放松和工序延时控制等，控制动作基本上是以简单的顺序逻辑动作为主。是属典型的继电逻辑顺序动作控制系统，这是PLC最擅长的功能，而且PLC具有体积小、重量轻、可靠性高、抗干扰能力强、编程简单、易于维护等特点，特别是替代继电器控制系统，这更是它的优势。

三、机械手系统的工作过程

机械手是一种模仿人手动作，并按设定程序、轨迹和要求代替人手抓、吸、搬运工件或工具进行操作的自动化装置。本系统的机械手部分由底盘、立杆、手臂、手组成。机械手移动到传送带B工件处夹紧工件，然后将工件移动到指定位置传送带A，接着放下工件，最后机械手回到初始位置（机械手的立杆最

高，手臂最短，手最松）。其中底盘由一个直流电机驱动，该电机的顺时针/逆时针旋转控制底盘的左/右旋转；立杆由一个步进电机驱动，通过改变CP 脉冲的频率来改变步进电机的速度，从而改变立杆的上升/下降的速度；手臂由另一个步进电机驱动，通过改变CP 脉冲的频率来改变步进电机的速度，从而改变手臂的伸/缩速度；手由一个直流电机控制，该电机的顺时针/逆时针旋转控制手的抓紧/放松。在机械手的各个相应位置都有行程开关用于定位。

传 送 带 立杆 A 工件

图3-1 机械手的基本结构图

四、机械手系统的设计思想

(一) 机械手的单个工作流程

机械手移动到传送带B工件处——夹紧工件——将工件移动到指定位置传送带A——放下工件——机械手回到初始位置五个过程完成，机械手通过PLC来控制，可实现这五个过程全自动依次运行：

1.械手移动到工件B处：机械手分别通过步进电机及直流电机来控制，使得机械手移到工件（传送带

B）处，移动的最大位置通过相应的限位开关来控制；

2.工件移动到指定位置：机械手分别通过步进电机及直流电机来控制，使得机械手移到工件（传送带

A）处，移动的最大位置通过相应的限位开关来控制；

3.夹放工件：通过夹紧/放下直流电机的正转来控制，夹紧工件通过定时器来控制，即凭经验设定一

个时间（本系统设为5S），在这个时间内机械手能完全夹紧工件；

4.放下工件：通过夹紧/放下直流电机的反转来控制，通过松限开关来控制

5.机械手回到初始位置：机械手分别通过步进电机及直流电机来控制，使得机械手移到初始位置处，

移动的最大位置通过相应的限位开关来控制；

(二) 机械手的操作方式

机械手的操作方式可分为手动操作方式和自动操作方式。自动操作方式又分为单步、单周期和连续操作方式。

1. 手动：用按钮操作对机械手的每一步运动单独进行控制，如：当选择上/下运动时，按下起动按钮，机械手上升，按下停止按钮，机械手下降；当选择左/右运动时，按下起动按钮，机械手左移，按下停止按钮，机械手右移；当选择夹紧/放松按钮时，按下起动按钮，机械手夹紧，按下停止按钮，机械手放松，该方式用于机械手系统的“回原位”操作本系统中，可用手动方式用于机械手的初始状态定位，用操作面板按钮的（SB5，SB6，SB7，SB8，SB9，SB10）来点动执行相应的各动作；

2. 单步：每按一次起动按钮SB3，机械手完成一步动作后，自动停止；

3. 单周期操作：机械手从原点开始，按一下起动按钮SB3，机械手自动完成一个周期的动作后，返回原位（如果在动作过程中，按下停止按钮SB4，机械手停在该工序上，再按下起动按钮SB3，则又从该工序继续工作，最后停在原位），本系统采用单周期方式进行机械手的工艺过程（机械手移动到传送带B工件处——夹紧工件——将工件移动到指定位置传送带A——放下工件——机械手回到初始位置）；

4. 连续操作：机械手从原点开始，按一下起动按钮SB3，机械手的动作将自动地、连续不断地周期性循环，在工作中，若按一下停止按钮SB4，则机械手将继续完成一个周期的动作后，回到原点自动停止

五、机械手系统设计

图5-1 系统设计

(一) 硬件设计

PLC系统一般由PLC、输入输出设备、控制柜等设备组成。在设计中应该考虑如下原则。

可靠性。可靠性是控制系统的生命，系统不可*，即使功能再完善，经济性再好也没有用，可*性不好的设备是没有市场的。在设计中，尽可能选择可*的元件和产品，虽然，初始投资可能多一点，但是，考虑到因为可*性不好造成的生产和维修费用，还是值得的。

b、功能完善。在保证控制功能的基础上，尽可能地将自检、报警等功能纳入设计方案。

c、经济性。在保证控制功能和可*性的基础上，尽可能地降低成本。

d、在保证前三条的基础之上，考虑系统的先进性和可扩展性。

(二) 软件设计

软件设计就是编写满足生产要求的梯形图或助记符程序，设计时的原则和要求如下：

a、建立PLC输入和输出量的接线表和接线图；

b、建立PLC存储器的分配表；

c、推导每一个输出、中间量和指令的动作和停止条件；

d、尽量减少扫描时间，方法是减少指令和内存的使用；

e、对每一个梯形图梯级给予注释；

f、要求逻辑关系明确，输出、中间量和指令的名字易懂好记。

图5-2 软件设计

六、机械手系统结构

(一) 系统结构构成图

(二) I/O地址分配

由于该CPU模块有24点数字量输入，24点数字量输出，所以不再需要输入模块，采用自动分配方式，模块上的输入端子对应的输入地址是X000-X027，输出端子对应的输出地址是Y000-Y027。

下图（图5-5）为PLC的I/O接线图，选用FX2N-48MT的PLC，系统共有15个输入设备和6个输出设备，分别占用PLC的15个输入点和6个输出点，为了保证系统在紧急情况下(包括PLC发生故障时)能可靠地切断PLC的负载电源，设置了交流继电器KM。在PLC开始运行时，按下“电源”按钮SB1，S使KM线圈得电后并自锁，KM的主触点接通，给输出设备提供电源，出现紧急情况，按下“急停”按钮SB2，KM触点断开。

图6-2

七编程软件(一) 正常运行流程图

图7-1 正常运行流程图

(二) 紧急停止流程图

图7-2 紧急停止流程图

八、机械手系统资源分配

(一) 数字量输入部分

该控制系统的输入有启动按钮、停止按钮、紧急停止按钮、上、下、伸、缩、松、底盘右、底盘左、初始限开关共11个输入点，具体的输入分配如表8-1所示

表8-1

(二) 数字量输出部分

该系统需要控制的外部设备有前进/后退步进电机，上升/下降步进电机，夹紧/放下直流电机，底盘旋转直流电机，其中步进电机可调速，直流电机有正/反转状态。具体的输出分配如表二

表8-2

(三) 定时器部分

该系统夹紧工件时，需要定时器来控制夹紧程度，假设5S机械手可以夹紧工件，具体的定时器分配如表8-3

表8-3

(四) 继电器部分

该控制系统的初始位置在程序中用一个内部继电器来表示，具体的内部继电器分配如表8-4所示

九、机械手系统程序

(一) 初始化

(1) 使系统达到初始位置

运动控制系统在运行过程中，可能会遇到断电，急停等状况，从而使系统处于某一种不可知状态，在这种状态下，对系统进行控制是很困难的，所以用手动方式，使系统进行一系

列调整，从而达到初始位置，以便于系统的正常控制。

(2) 复位、清除某些继电器、数据寄存器

在PLC由运行状态切换到编程状态，再切换到运行状态时，某些继电器、数据寄存器会记忆上

次运行时得到的状态或结果，从而对本次程序运行产生严重影响。

(3) 赋予系统运行的一些基本参数

在初始化程序段中，经常使用的信号是系统初始化特殊内部继电器R9013，它在PLC的模式下处

于“RUN”的状态下，从断电状态到通电状态，或者是在通电状态下，PLC的模式开关从“PRO GRAMM”模式转换为“RUN”模式（不论是通过硬件开关切换还是通过软件切换）的时候闭合

一个扫描周期，然后一直保持断开状态。

(二) 直流电机的正/反转控制

直流电机的控制电路较为简单，一般只要考虑PLC的输入、输出的接线就可以了。这样的电路单

独没有什么意义，但是却是生产线上不可缺少的部分，一般应用电路如下图

直流电机的正、反转控制也是生产线上常见的控制要求，实现起来也是比较简单的，只是在应用中要注意以下一些方面：

A.在某些应用电路中，是不允许正、反转控制继电器同时得电闭合的，在这种控制方式中，单纯的依靠软件户所来保证正、反转控制继电器不要同时得电是不可靠的，这是因为PLC执行指令的速度很快，而外部的实际继电器由线圈得电到触电闭合，以及由线圈失电到触点断开均需要延迟一段时间。在这种情况下，电路中不仅要有软件互锁，而且要由硬件互锁。具体的如图所示

图9-2 直流电机正/反转硬件互锁控制电路

B. 在实际应用中，可以采用H桥驱动直流电机，实现正、反转控制。常用的H桥驱动电路有两种，如图所示，各有利弊。

图9-3 直流电机的H桥驱动方式

（A）图所是得电路结构十分简单，广泛应用于小型低转动惯量直流电动机控制电路中。因为这种电路KM1或KM2单独闭合时，直流电动机可以正向旋转或者反向旋转；当KM1和KM2均闭合或者均不闭合，这时候直流电动机相当于电枢短接，可以将直流电动机很快的制动停止，此时制动电流与直流电动机的容量以及转动惯量有直接的关系，所已不适合大容量的直流电动机和大转动惯量的控制应用中。（B）图所时的电路结构相对来说较为复杂，这种电路当KM1或KM2单独闭合时，直流电动机也可以正