可编程控制器的机械手设计.docx

1、可编程控制器的机械手设计基 于 可 编 程 控 制 器 的 机 械 手 设 计自动化专业学生 刘玉建指导教师 李坤摘要：机械手是在自动化生产过程中发展起来的一种新型装置，广泛应用于工业生产和其他领域。可编程控制器（PLC）已在工业生产过程中得到广泛的应用。组态软件的应用，极大地辅助了PLC的应用范围的推广。应用可编程控制器控制机械手能实现各种规定的工序动作，对生产过程有着十分重要的意义。论文以施耐德TWDLCAADRF40型PLC为基础，介绍PLC在机械手搬运控制中的应用，设计了一套可行的机械手控制系统，并给出了详细的PLC程序、组态王组态设计过程。设计完成的机械手可以在空间抓、放、搬运物体等

2、，动作灵活多样。关键词：可编程控制器；机械手；控制；组态王Manipulator System Design Based On PLCStudent majoring in Automation Liu YujianTutor Li KunAbstract:The manipulator is a new device developed in the automatic production process. It is widely used in industrial producing and other fields. Programmable Logic Controller (P

3、LC), has been widely used in industrial producing as well. With the application of Configuration Software,its application range is greatly enlarged. Manipulator with PLC control can complete various specified procedural actions,which has very vital significance to the production process. Based on th

4、e PLC of Schneider TWDLCAADRF40 type,this paper introduces PLC application in manipulator transportation control system, and design a available manipulator control system,with provideing PLC programming process and configuration process in detail. The manipulator designed by this paper,can grap,put

5、and carry object,etc.in the space.Keywords:PLC;Manipulator;Control;KingView1 引言1.1 课题提出与研究意义随着工业生产自动化规模的扩大，生产过程日趋复杂。生产工况也有趋于恶劣的态势，这对一线工人的操作技能也提出了更高的要求，同时操作工人的工作安全也受到了相应的威胁。在自动化生产领域中，工业机械手是近几十年发展起来的。工业机械手的是从工业机器人中分支出来的。其特点是可通过编程来完成各种预期的作业任务，在构造和性能上兼有人和机器各自的优点，尤其体现了人的智能和适应性。机械手作业具有准确性和各种环境中完成作业的能力。借助P

6、LC强大的工业处理能力，很容易实现工业生产的自动化。基于此思路设计的机械手，在实现各种要求的工序前提下，大大提高了工业过程的质量，而且大大解放了生产力，改善了工作环境，减轻了劳动强度，节约了成本，提高了生产效率，具有十分重要的意义。同时，借助组态软件的辅助作用，大大提高了系统的工作效率。1.2 工业机械手发展现状机械手是一种能自动化定位控制并可重新编程序以变动的多功能机器，它有多个自由度，可用来搬运物体以完成在各个不同环境中工作。机械手由执行机构、驱动-传动机构、控制系统、智能系统、远程诊断监控系统五部分组成。驱动-传动机构与执行机构是相辅相成的，在驱动系统中可以分：机械式、电气式、液压式和复

7、合式，其中液压操作力最大。简易机械手在各类全自动化和半自动化生产线上应用的十分广泛，主要用于零部件或成品在固定位置之间的移动，代替人工作业，实现生产自动化。本设计中的机械手采用上下升降加平面转动式结构，各动作由PLC控制相关电机和启动执行元件完成。能十分方便的嵌入到各类生产工业生产线中。日益复杂的工业过程促进了机械手在工业生产中的应用。对相应的控制精度、控制稳定性也提出了更高的要求。其现状是在性能不断提高（高速度、高精度、高可靠性、便于操作和维修）的同时，单机价格不断下降。机械结构向模块化、可重构化发展。器件集成度、系统的可靠性、易操作性和可维护性提高。伴随科学技术的不断进步，机器人与工业自动

8、化技术的迅猛发展 ,尤其是移动机械手(Mobile Manipulator)系统的不断进步，为危险品的安全处理提供了新的思路。1.3 本设计的主要工作针对工业现场的控制要求，本文将详细介绍以可编程控制器为处理单元的机械手过程控制系统设计与实现。首先，在本文的第二部分阐述可编程控制器的概况，施耐德PLC及其编程环境- TwidoSoft，PC与PLC的通信。其次，在本文的第三部分阐述机械手系统的基本组成与控制原理。包括PLC输入输出点的分配，机械手步进电机的驱动，以及相关的位置检测电路，以及确立系统的软件的整体框架，进行相关的软件设计。最后对系统设计进行总结。最后，针对本设计，完成相关的组态工作

9、，直观的显示系统的动态运动过程，所用平台为亚控公司的组态王6.5.1版。本文对设计的每一部分都给出了较详细的的设计步骤，并对系统搭建的结果进行了实物验证，取得了很好的效果。2 可编程控制器概述2.1 PLC的应用与发展可编程控制器（Programmable Logic Controller）是计算机家族中的一员，是为工业控制应用而设计制造的。早期的可编程控制器主要用来代替继电器实现逻辑控制，称可编程逻辑控制器（Programmable Logic Controller），简称PLC。随着技术的发展，这种装置的功能已经大大超过了逻辑控制的范围，不仅具有逻辑控制功能，而且还能实现数据运算、数据传输

10、和处理等功能，使其真正成为一种电子计算机工业控制设备，因此，今天这种装置称作可编程序控制器，简称PC。但是为了避免与个人计算机（Personal Computer）的简称PC混淆，所以仍将可编程序控制器简称PLC。1987年，国际电工委员会（IEC）颁布了新的PLC标准及其标准定义：“可编程控制器是一种数字运算操作的电子系统，专为在工业环境而设计。它采用可编程序的存储器，用来在其内部存储执行逻辑运算、顺序控制、定时、计数和算术运算等操作指令，并通过数字模式或模拟模式的输入、输出，控制各种类型的机械或生产过程。而有关外围设备，都应按照易于与工业系统联成一个整体，易于扩充其功能的原则设计”。PLC

11、就是使用一系列指令构成的程序来操作、控制相关工业控制机械，使其形成一个完整的工业控制系统，以完成各种各样的控制功能。12.1.1 PLC的工作原理和应用领域随着微电子技术、计算机技术和数字通信技术的高速发展，PLC产品高度融合了计算机产业最先进的技术与工业自动控制的经典理论，在其功能及性能指标上得以丰富和完善，从而突破了传统PLC的概念，在中、小型控制领域内极大地扩展了其应用范围。在特定的范围内，高性能价格比已成为新型PLC的最突出的特点。PLC以其高可靠性、适应性强和使用方便等突出特点在自动化控制领域应用广泛。另外PLC的制造成本不断降低，而其功能却不断增强。目前在先进工业国家中PLC已成为

12、工业控制的标准设备，应用面几乎覆盖了所有工业企业，诸如钢铁、冶金、水泥、石油、化工、电力、机械制造、汽车、造纸、纺织、环保、交通、建筑等各行各业。特别是在轻工业行业中，生产门类多、加工方式多变、产品更新换代快，PLC广泛应用在组合机床自动化生产线、专用机床、塑料机械、包装机械、电梯等电气设备中。PLC已跃居现代工业自动化三大支柱（PLC、ROBOT、CAD/CAM）的主导地位。PLC广泛的应用在以下领域1）逻辑控制领域2）运动控制领域3）过程控制领域4）数据处理领域5）多级控制领域2.1.2 PLC的的发展趋势目前，PLC技术发展的总体趋势是系列化、通用化和高性能化，主要表现在以下方面：1）在

13、系统构成规模上向大小两个方向发展发展小型（超小型）化、专业化、模块化、低成本、高性能PLC，以真正代替最小的继电器控制系统；发展大容量、高速度（超高速）、多功能、高性价比的PLC，已满足现代企业中那些大规模、复杂系统自动化的需要。2）功能不断增强，各种应用模块不断推出大力加强过程控制和数据处理功能，提高组网和通信能力，开发多种高性能模块，以使各种模块的自动控制系统更加强大、更加可靠、组成和维护更加灵活方便，使PLC的应用更加广泛。3）产品更加规范化、标准化PLC厂家在使硬件及编程工具换代频繁、丰富多样、功能提高的同时，日益向MAP（制造自动化协议）靠拢，并使PLC基本部件，如输入输出模块、联网

14、通信模块、接线端子、通信协议、编程语言和工具方面的技术规格规范化、标准化，使不同的产品间能够相互的兼容、易于组网，以方便用户，扩大产品的应用领域。2.2 PLC的工作原理及功能特点为了介绍PLC的工作原理我们首先在本节介绍PLC的基本结构，然后介绍PLC的工作原理，最后简单介绍一下PLC的主要功能和特点。2.2.1 PLC的基本结构可编程控制器的基本结构框图如图2.1示。可编程序控制器主要有CPU模块、输入模块、输出模块、编程装置和电源组成。 图2.1 PLC的基本结构2.2.2 PLC工作原理当PLC投入运行后，其工作过程一般分成三个阶段，即输入采样、用户程序执行和输出刷新三个阶段。完成上述

15、三个阶段称作一个扫描周期。在整个运行期间，PLC的CPU以一定的扫描速度重复执行上述三个阶段，如图2.2所示。图2.2 PLC的扫描周期1）输入采样阶段在输入采样阶段，PLC以扫描方式依次地读入所有输入状态和数据，并将它们存入I/O映像区中的相应单元内。输入采样结束后，转入用户程序执行和输出刷新阶段。在这两个阶段中，即使输入状态和数据发生变化，I/O映像区中的相应单元的状态和数据也不会改变。因此，如果输入是脉冲信号，则该脉冲信号的宽度必须大于一个扫描周期，才能保证在任何情况下，该输入均能被读入。2）用户程序执行阶段在用户程序执行阶段，PLC总是按由上而下的顺序依次地扫描用户程序（梯形图）。在扫

16、描每一条梯形图时，又总是先扫描梯形图左边的由各触点构成的控制线路，并按照先左后右、先上后下的顺序对由触点构成的控制线路进行逻辑运算，然后根据逻辑运算的结果，刷新该逻辑线圈在系统RAM存储区中对应位的状态；或者刷新该输出线圈在I/O映像区中对应位的状态；或者确定是否要执行该梯形图所规定的特殊功能指令。3）输出刷新阶段当扫描用户程序结束后，PLC就进入输出刷新阶段。在此期间，CPU按照I/O映像区内对应的状态和数据刷新所有的输出锁存电路，再经过输出电路驱动相应的外设。这时才是PLC的真正输出。为了提高工作的可靠性，及时接受外来的控制命令，PLC在每次扫描期间，除完成上述三步操作外，通常还要进行故障

17、自诊断，完成通讯处理要求。每次扫描开始，先执行依次自诊断程序，对各输入输出点，存储器和CPU等进行诊断，诊断的方法通常是测试出各部分是否工作正常，若不一致则认为有故障。此时，PLC立即启动关机程序，保留现行工作状态并关断所有输出点，然后停机。诊断结束后，如没发现故障，PLC将继续往下扫描，检查是否有编程器等的通信请求。如果没有则进行相应的处理，比如，接受编程器发来的命令，把要显示的状态数据，出错信息送给编程器显示等。处理完通信后，PLC继续扫描，输入现场信息，顺序执行用户程序，输出控制信号，完成一个扫描周期。然后又从自诊断开始，进行第二轮扫描。PLC就是这样不停反复循环，实现对机器的连续控制，

18、直到接收到用户停机命令，或因停电、出现故障等原因才停止工作。3）PLC的主要功能和特点PLC的主要功能有：逻辑控制、定时控制、计数控制、步进（顺序）控制、PID控制、数据控制（PLC具有数据处理能力）、远程I/O功能、通信和联网；另外，有些PLC还有很多特殊功能模块，适用于各种特殊控制的要求，诸如定位控制模块，CRT模块等。可编程控制器（PLC）的主要特点如下：1） 高可靠性2） 丰富的I/O接口模块3） 采用模块化结构4） 编程简单易学5） 安装简单，维修方便2.3 施耐德Twido系列PLC介绍本设计中使用的可编程序控制器为施耐德公司的TWDLCAADRF40型PLC，隶属于Twido系列

19、。Twido PLC是紧凑型可编程序控制器，可应用于各种设备的自动化控制系统中。Twido系列小型PLC具有灵活的配置、紧凑的结构、强大的功能、丰富的通信方式、完善的编程软件、CPU的FIRMWARE可不断升级等特点，因此性价比较高。2.3.1 Twido PLC的功能概述Twido是小型PLC，由本体和扩展模块组成，能够满足各种设备的自动化控制需要。应用领域极为广泛，覆盖所有与自动检测、自动化控制相关的工业及民用领域，包括各种机床、机械、电力设施、民用设施、环境保护设备、汽车、机器人等等。如冲压机床、印刷机械、中央空调、电梯控制、运动系统等等。Twido PLC除了具有PLC的基本控制功能以

20、外，还有以下特点：1） 灵活的配置多种CPU模块、数字量、模拟量扩展模块、通信模块以及多种可选件，使得控制系统的硬件架构更适合用户的应用要求。2） 紧凑的结构体积小巧，多种接线方式，易于安装。如附带40点I/O的CPU模块的正面面积只有名片大小。3）强大的功能除具有PLC基本的控制和运算功能之外，还有双字、浮点数、三角函数、PID等的运算指令。单机的控制点数高达264点，用户程序容量达64KB。4） 丰富的通讯方式Twido PLC支持多种通讯方式，如Twido PLC之间的Remote I/O和对等PLC的通信方式、与其他智能设备的自由ASCII通信方式、Modbus的主站和从站通信方式、通

21、过以太网的通信方式，甚至有一些PLC已内置以太网接口。众多的通信功能使Twido PLC与其他电气设备的配合更加完美。5） 完善的编程软件全中文的Windows编程界面和在线帮助文档使用户编程更加方便、更高效、支持多种编程接口，如串口、USB口、以太网口，甚至是远程有线、无线接口方式。6） CPU的FIRMWARE可不断升级在不改变任何硬件的情况下，只需要更新CPU的FIRMWARE，就能使CPU的功能不断地升级，满足用户新的需求。（就像升级计算机的BIOS一样）22.3.2 Twido PLC的工作模式Twido PLC具有两种工作模式，分别是：运行（RUN）模式和停止（STOP）模式。在运

22、行模式下，通过执行反映控制要求的用户程序来实现控制功能；在停止模式下，Twido PLC不执行用户程序，此时可设置CPU的硬件功能，并将用户程序、数据以及硬件设置信息下载到PLC的CPU中。可以通过TwidoSoft编程软件控制Twido PLC的运行与停止。PLC前面板的LED显示当前的工作模式。Twido PLC通电后，需要对硬件和软件做一些初始化的工作。初始化后，Twido PLC按照循环扫描的方式，完成包括执行用户程序在内的各项不同的任务，周而复始地分阶段执行一系列任务。任务执行一次成为一个扫描周期，在一个扫描周期内，CPU工作流程如图2.3。1） 读输入2） 执行用户程序3） 处理通

23、讯任务4） 执行自诊断5） 写输出6） 中断程序的处理图2.3 Twido PLC的扫描过程示意图2.4 TwidoSoft编程环境2.4.1 安装TwidoSoft软件本文中所有的内容是基于TwidoSoft3.5版本。安装界面如图2.4。图2.4 程序安装TwidoSoft是一个用于Twido可编程控制器的配置、编写和维护应用程序的图形化开发环境。TwidoSoft是一款32位的基于Windows的程序，是标准的Windows界面，有应用程序浏览器和多窗口浏览。支持编程、调试和配置，可与控制器进行多种方式的通信，如串行口、USB、以太网、MODEM拨号等。2.4.2 编程界面和硬件配置Tw

24、idoSoft运行，新建立程序后，用户需要根据自己的需要进行CPU型号的更改，操作方式为：右键单击原来的CPU，选中“更改控制器类型”，选择所需的CPU类型，点击“更改”，完成相关操作，本文所用CPU为TWDLCAA40DRF，如图2.5。图2.5 控制器类型2.4.3 PLC与PC的通信TwidoSoft软件与Twido PLC连接时可采用多种通讯方式，如串行口、USB、以太网、MODEM+电话线，因此在TwidoSoft与Twido PLC连接前，用户需根据实际使用的硬件连接方式，在TwidoSoft的连接管理菜单中做相应的设定。在“文件”菜单中，点击“首选项”，显示“首选设置”，可对通讯

25、方式做相关设定，本文采用USB方式，如图2.6。图2.6通讯方式设定3 机械手实物模型设计本设计的系统全貌如图3.1。图3.1 系统全貌图3.1 系统概述机械手实物模型的机械结构采用滚珠丝杆、滑杆、气缸、气夹等机械部件组成；电气方面有步进电机、步进电机驱动器、传感器、开关电源、电磁阀等电子器件组成；该模型是涵盖了PLC技术，位置控制技术、气动技术有机结合成一体的控制仪器。本设计中采用的机械手，可在三维空间内运动。水平（X）轴、垂直（Y）轴采用步进电机控制，底盘的旋转采用直流电机控制，抓取物体的电磁阀采用气动形式。步进电机的控制，由对应的步进电机驱动器电路完成。完成本设计需要的实验设备有：1）机

26、械手模型2）计算机3）导线4）气泵5）晶体管输出型可编程控制器(带编程电缆) 机械手的控制面板分以下几个模块（1）步进电机驱动及步进电机驱动器电流设定为0.63A，细分设定为8细分。将24V电源接入驱动器，此时驱动器的电源指示灯应点亮。将24V与OPTO端（驱动器使能端）连接起来。PUL端是脉冲输入端。DIR是方向控制输入端。（2）直流电机本模型用的气夹电机和底座电机均是24V直流电机，PLC控制两个直流继电器的吸合来控制电机的正转和反转。（3）旋转编码盘在本模型底座上有一个旋转编码盘，在底座旋转时，在此产生一个VP-P为24V的方波信号，可以提供给PLC的高速计数器，用于机械手的定位控制。（

27、4）接近开关在本模型中底座和气夹的限位通过4个电感式接近开关来完成。接近开关与触头接近时接近指示灯点亮、输出低电平，否则为高电平。（5）行程开关在本模型中两个滚珠丝杆的限位通过4个滚轴式行程开关来完成。当行程开关压下时，常开触点闭合，给PLC一个控制信号。（6）电磁阀与平行气夹本模型使用的电磁阀动作时平行气夹夹紧，动作则张开。3.1.1 技术性能1）输入电源：单相三线220V10% 50Hz 2）工作环境：温度-10+40 相对湿度85%(25) 海拔4000m3）绝缘电阻：大于3M4）外形尺寸：8050120cm33.1.2 设计原理1步进电机用二相八拍混合式步进电机，主要特点：体积小，具有

28、较高的起动和运行频率，有定位转矩等优点。本模型中采用串联型接法，其电气图如图3.2所示： 3.2步进电机电气图2步进电机驱动器步进电机驱动器主要有电源输入部分、信号输入部分、输出部分等。驱动器参数如下列图表所示：（1）电气规格说明最小值典型值最大值单位供电电压182440V均值输出电流0.2111.50A逻辑输入电流61530mA步进脉冲响应频率100kHz脉冲低电平时间51s（2）电流设定电流值SW1SW2SW30.21AOFFONON0.42AONOFFON0.63AOFFOFFON0.84AONONOFF1.05A0FFONOFF1.26AONOFFOFF1.50AOFFOFFOFF（3

29、）细分设定细分倍数步数/圈（1.8整步）SW4SW5SW61200ONONON2400OFFONON4800ONOFFON81600OFFOFFON163200ONONOFF326400OFFONOFF6412800OFFONOFF由外部确定动态改细分/禁止工作OFFOFFOFF（4）接线信号描述信 号功 能PUL脉冲信号：上升沿有效，每当脉冲由低变高时电机走一步DIR方向信号：用于改变电机转向，TTL平驱动OPTO光耦驱动电源ENA使能信号：禁止或允许驱动器工作，低电平禁止GND直流电源地+V直流电源正极，典型值+24VA+电机A相A-电机A相B+电机B相B-电机B相（5）PLC控制器与步进

30、电机驱动器连接的工作原理如图所示：驱动器电源由面板上电源模块提供，注意正负极性，驱动器信号端采用+24V供电，需加1.5K限流电阻（见图3.3中1.5K电阻）。驱动器输入端为低电平有效，在使用不同厂家的PLC产品配套此模型使用时，要选择相应的输出方式，或者加入合适的电平转换板进行电平转换。图3.3控制驱动电路3传感器：(1)接近开关：接近开关有三根连接线（棕、兰、黑）棕色接电源的正极、蓝色接电源的负极、黑色为输出信号，当与档块接近时输出电平为低电平，否则为高电平。与PLC之间的接线图如下，当传感器动作时，输出端对地接通。PLC内部光耦与传感器电源构成回路，PLC信号输入有效。电气示意图如图3.

31、4。图3.4传感器电气示意图(2)行程开关：当档块碰到开关时，常开点闭合。4本装置需采用晶体管输出型可编程控制器，可同时输出两路脉冲到步进电机驱动器，控制步进电机运行。5旋转码盘：本装置中机械手每旋转3编码盘发出一个脉冲。6直流电机驱动单元：本装置中直流电机驱动模块是有两个继电器的吸合与断开来控制电机的转动方向的。3.2 控制要求本设计中，机械手模型的执行顺序为：1.开机复位 2.横轴前升 3.手旋转到位 4.电磁阀动作，手张开 5.竖轴下降 6.电磁阀动作，手夹紧 7.竖轴上升 8.横轴缩回 9.底盘旋转到位 10.横轴前伸 11.手旋转 12.竖轴下降 13.电磁阀动作，手张开 14.竖轴上升 15.复位气夹在电磁阀未通电动作