(完整版)基于plc的机械手控制系统设计

1、1-LX.1前言随着我国工业生产的飞跃发展，自动化程度的迅速提高，实现工件的装卸、转向、输送或操持焊枪、喷枪、扳手等工具进行加工、装配等作业的自动化，已愈来愈引起人们的重视。机械手是在机械化、自动化生产过程中发展起来的一种新型装置。近年来，随着电子技术特别是电子计算机的广泛应用，机器人的研制和生产已成为高技术领域内迅速发展起来的一门新兴技术，它更加促进了机械手的发展，使得机械手能更好地实现与机械化和自动化的有机结合。机械手是模仿着人手的部分动作，按给定程序、轨迹和要求实现自动抓取、搬运或操作的自动机械装置。 在工业生产中应用的机械手被称为“工业机械手”。机械手虽然目前还不如人手那样灵活，但它具

2、有能不断重复工作和劳动、不知疲劳、不怕危险、抓举重物的力量比人手大等特点，因此，机械手已受到许多部门的重视，并越来越广泛地得到了应用，生产中应用机械手可以提高生产的自动化水平和劳动生产率；可以减轻劳动强度、保证产品质量、实现安全生产尤其在高温、高压、低温、低压、粉尘、易爆、有毒气体和放射性等恶劣的环境中，它代替人进行正常的工作，意义更为重大。本文将通过西门子 PLC 控制机械手，PLC 是可编程控制器(ProgrammableLogicController)的简称， 是在继电顺序控制基础上发展起来的以微处理器为核心的通用的工业自动化控制装置。随着电子技术和计算机技术的迅猛发展，PLC 的功能也

3、越来越强大，更多地具有计算机的功能。目前 PLC 已经在智能化、网络化方面取得了很好的发展。该系统利用西门子 PLC，在步进电机驱动下，完成对机械手在搬运过程中的下降、夹紧、上升、右旋、下降、放松、上升、左旋等全过程自动化控制，并对非正常情况实行自动报警和自动保护，实现企业的机电一体化，提高企业的生产效率。基于 PLC 的机械手控制系统设计21机械手概述1.1 机械手简介机械手是模仿着人手的部分动作，按给定程序、轨迹和要求实现自动抓取、搬运或操作的自动机械装置。它可代替人的繁重劳动以实现生产的机械化和自动化，能在有害环境下操作以保护人身安全，因而广泛应用于机械制造、冶金、电子、轻工和原子能等部

4、门。机械手是工厂企业高度自动化的标志，它能完成许多高技术难度和繁重的体力劳动，尤其对于高温、高压、高湿度、污染等不适宜人工工作的环境中，机械手起到了不可取代的作用。1.2 机械手组成机械手主要由手部、驱动系统、控制系统组成。结构如图 1T 所示：P_*驅动系统驅动系统驱动系统驱动系统图 1-1机械手结构图3Fig.1-1Manipulatorstructure（1）手部即与物件接触的部件。手部是用来抓持工件（或工具）的部件，根据被抓持物件的形状、尺寸、重量、材料和作业要求而有多种结构形式，如夹持型、托持型和吸附型等。（2）驱动系统使手部完成各种转动（摆动）、移动或复合运动来实现规定的动作，改变

5、被抓持物件的位置和姿势。运动机构的升降、伸缩、旋转等独立运动方式，称为机械手的自由度。为了抓取空间中任意位置和方位的物体，需有 6 个自由度。自由度是机械手设计的关键参数。自由度越多，机械手的灵活性越大，通用性越广，其结构也越复杂。一般专用机械手有 23 个自由度。1.3 机械手的应用随着科学技术的发展，机械手也越来越多地被应用。在机械工业中，铸、锻、焊、铆、冲压、热处理、机械加工、装配、检验、喷漆、电镀等工种都有应用的实例。其它部门，如轻工业、建筑业、国防工业等工作中也均有所应用机械工业中，应用机械手的主要目的是：一、可以提高生产过程的自动化程度应用机械手，有利于实现材料的传送、工件的装卸、

6、刀具的更换以及机器的装配等的自动化程度，从而可以提高劳动生产率和降低生产成本。二、可以改善劳动条件、避免人身事故。在高温、高压、低温、低压、有灰尘、噪声、臭味、有放射性或有其它毒性污染以及工作空间狭窄等场合中，用人手直接操作时有危险或根本不可能。而应用机械手即可部分或全部代替人安全的完成作业，使劳动条件得以改善。在一些简单、重复，特别是较笨重的操作中，以机械手代替人手进行工作，可以避免由于操作疲劳或疏忽而造成的人身事故。三、可以减少人力，并便于有节奏地生产应用机械手代替人手进行工作，这是直接减少人力的一个侧面，同时由于应用机械手可以连续地工作，这是减少人力的另一个侧面。因此，在自动化机床和综合

7、加工自动线上，目前几乎都设机械手，以减少人力和更准确地控制生产的节拍，便于有节奏进行生产。基于 PLC 的机械手控制系统设计4由此可见，有效地应用机械手，是发展工业的必然趋势。2PLC的简介2.1 PLC 的产生19681968 年美国通用汽车公司（GMGM）招标要求: :软连接代替硬接线; ;维护方便; ;可靠性高于继电器控制柜; ;体积小于继电器控制柜; ;成本低于继电器控制柜; ;有数据通讯功能; ;输入 115V;115V;可在恶劣环境下工作; ;扩展时， 原系统变更要少; ;用户程序存储容量可扩展到 4K4K。核心思想：用程序代替硬接线，输入/ /输出电平可与外部装置直接相联，结构易

8、于扩展，这是 PLCPLC 的雏形。19691969 年美国 DECDEC 公司研制出世界上第一台 PLCPLC（PDP-14PDP-14）,并在 GMGM 公司汽车生产线上应用成功。2.2 PLC 的定义和特点2.2.1 PLC 的定义的定义美国电气协会制造商协会 NEMA 和国际电工委员会 IEC 对可编程控制器分别作了定义：可编程控制器是一种专门用于工业环境的、以开关量逻辑控制为主的自动控制装置。它具有存储控制程序的存储器，能够按照控制程序，将输入的开关量（或模拟量）进行逻辑运算、定时、计数和算术运算等处理后，以开关量（或模拟量）的形式输出，控制各种类型的机械或生产过程。早期的可编程控制

9、器，主要用于开关量逻辑控制，所以称为可编程逻辑控制器，简称 PLC，后来随着计算机技术不断发展，其功能已不仅限于开关逻辑控制，所以被称之为可编程控制器 PC，但这很容易和个人计算机 PC 相混淆，因此,一般把 PLC 作为可编程控制器的简称。2.2.2 PLC 的特点的特点可编程控制器之所以能够得到迅速发展和广泛应用，主要是由于它具有以下特点：（1）可靠性高，抗干扰能力强用软件实现大量的开关量逻辑运算，克服了因继电器触点接触不良而造成的故障；输入采用直流低电压，更加可靠、安全；5面向工业环境设计，采取了滤波、屏蔽、隔离等抗干扰措施，适应各种恶劣的工作环境，远远地超过了传统的继电器控制系统和一般

10、的计算机控制系统。(2) 编程简单， 易于掌握 PLC 采用梯形图方式编写程序， 与继电器控制逻辑的设计相似，具有直观、简单、容易掌握等优点。(3) 功能完善，灵活方便随着 PLC 技术的不断发展，其功能更加完善，不仅具有开关量逻辑控制功能和步进、计算功能，而且还具有模拟量处理、温度控制、位置控制、网络通信等功能。既可以单机使用、也可联网运行，既可集中控制、也可分布控制或者集散控制。而且在运行过程中，可随时修改控制逻辑，增减系统的功能。(4) 体积小、质量轻、功耗低由于采用了单片机等集成芯片，体积小、质量轻、机构紧凑、功耗低。2.3 可编程控制器的主要性能指标可编程控制器的性能指标有很多，主要

11、有以下几项指标。(1)输入/输出点数(I/O)I/O 点数是指可编程控制器外部输入、输出端子数的总和。它标志着可以接多少个开关按钮和可以控制多少个负载。(2) 存储容量存储容量是指可编程控制器内部用于存放用户程序的存储容量。(3) 扫描速度一般以执行 1000 步指令所需的时间来衡量，单位为 ms/千步，也有以执行一步指令所需来计算，单位 us/步。(4) 功能扩展能力可编程控制器除了主模板块之外， 通常都可配备一些可扩展模块，以适应各种特殊功能应用的需要。如 A/D 模块、D/A 模块、位置控制模块等。(5) 指令系统指令系统是指一台可编程控制器指令的总和， 它是衡量可编程控制器功能强弱的主

12、要指标。2.4 可编程控制器的分类通常 PLC 产品可按结构形式、控制规模等进行分类。(1)按结构形式分类按结构形式不同，可分为整体式和模块式两类。整基于 PLC 的机械手控制系统设计6体式的 PLC 是将电源、CPU、存储器、输入/输出单元等各个功能部件集成在一个机壳内，从而具有结构经凑、体积小、价格低等优点，许多小型 PLC 多采用这种机构。模块式的 PLC 将各个功能部件做成独立模块，如电源模块、CPU 模块、I/O模块等，然后进行组合。(2)按控制规模分类按控制规模大小，可分为小型、中型和大型 PLC 三种类型。1) 小型 PLCPLC。小型 PLCPLC 的 I/OI/O 点数在 2

13、56256 点以下，存储容量在 2KB2KB 以内，其中输入输出点数小于 6464 点的 PLCPLC 又称为超小型或微型 PLCPLC， 具有逻辑运算、 定时、计数、移位及自诊断、监控等基本功能。2) 中型 PLC。中型 PLC 的开关量 I/O 点数通常在 256-2048 点之间，用户程序存储器的容量为 2-8KB，除具有小型机的功能外，还具有较强的模拟量 I/O、数字计算、过程参数调节，如比例、积分、微分 PID)调节、数据传送与比较、数制转换、中断控制、远程 I/O 及通信联网功能。3) 大型 PLC。大型 PLC 也称为高档 PLC，I/O 点数在 2048 点以上，用户程序存储容

14、量在 8KB 以上，其中 I/O 点数大于 8192 点的又称为超大型 PLC，除具有中型机的功能外，还具有较强的数据处理、模拟调节、特殊功能函数运算、监视、记录、打印等功能，以及强大的通信联网、中断控制、智能控制和远程控制等功能。2.5 PLC 系统的组成PLC 是一种以微处理器为核心的工业通用自动控制装置，其结构与微型计算机控制系统相似，也是有硬件系统和软件系统两大部分组成。2.5.1PLC 的硬件结构的硬件结构一套 PLC 系统在硬件上由以下几部分组成：(1)中央处理器(CPU)与计算机一样，是 PLC 的核心部件。(2)存储器 PLC 配有两种存储器：系统存储器和用户存储器。(3)输入

15、/输出(I/O)接口电路。(4)电源。(5)扩展单元。(6)外部设备。7其中，各部分通过总线(电源总线、控制总线、地址总线、数据总线)连接而成。其结构简图如下：基于 PLC 的机械手控制系统设计8图 2-1PLC硬件结构图Fig.2-1PLChardwarestructure2.5.2 PLC 的软件的软件PLC 的软件是指 PLC 所使用的各种程序的集合。它由系统程序（系统软件）和用户程序（用户软件）组成。（1）系统程序系统程序包括监控程序，输入译码程序及诊断程序等。（2）用户程序用户程序是用户根据控制要求，用 PLC 的编程语言（如梯形图）编制的应用程序。2.6 可编程控制器的工作方式可编

16、程控制器在进入 RUN 状态之后，采用循环扫描方式工作。从第一条指令开始，在无中断或跳转控制的情况下，按程序存储的地址号递增的循序逐条执行程序，即按顺序逐条执行程序直到程序结束。然后再从头开始扫描，并周而复始地重复进行。FJ-!第曲)人1扫抽周期第N牛扫描周期篦3+1)个扫1描周期i电源电源r1存储器存储器EPR.OM受控元件出出黴处理黴处理外外部部设设备备输输A件件运算运算控制控制输入信号件件I/O扩扩展展单单元元9i*11111WB输?.采样！11输出刷新1输几吴样托户程序执行输岀刷新图 2-2PLC工作方式图Fig.2-2PLCworkwayfigure可编程控制器工作的扫描过程包括五个

17、阶段：内部处理、通信处理、输入扫描、程序执行、输出处理。PLC 完成一次扫描过程所需的时间成为扫描周期。扫描周期的长短与用户程序的长度和扫描速度有关。2.7PLC 的编程语言PLC 的编程语言有梯形图语言、助记符语言、顺序功能图语言等。其中前两种语言用的较多，流程图语言也在许多场合被采用。1梯形图语言(1) 梯形图从上至下编写，每一行从左至右顺序编写。PLC 程序执行顺序与梯形图的编写顺序一致。(2) 图左、右边垂直线称为起始母线、终止母线。每一逻辑行必须从起始母线开始画起，终止母线可以省略。(3) 梯形图中的触点有两种，即动合触点和动断触点。(4) 梯形图的最右端必须连接输出元素。(5) 梯

18、形图中的触点可以任意串、并联，而输出线圈只能并联，不能串联。2.助记符语言助记符语言是 PLC 命令的语言表达式。用梯形图编程虽然直观、简便，但要求 PLC 配置较大的显示器时可输入图形符号，这在有些小型机上常难以满足，所以助记符语言也是一种较常用的一种编程方式。 不同型号的 PLC,其助记符语言也不同，但其基本原理是相近的。编程时，一般先跟据要求编制梯形图语言,然后再根据梯形图转换成助记符语言。3.顺序功能图语言顺序功能图 SFC 是一种描述顺序控制系统功能的图解表示法， 主要由“步”、基于 PLC 的机械手控制系统设计10“转移”及“有限线段”等元素组成，它将一个完整的控制工程分为若干个阶

19、段（状态），各阶段具有不同的动作，阶段间有一定的转换条件，条件满足就实现状态转移，上一状态动作结束，下一动作开始。2.8PLC 的应用领域目前，PLC 在国内外已广泛应用于钢铁、石油、化工、电力、建材、机械制造、汽车、轻纺、交通运输、环保及文化娱乐等各个行业，使用情况大致可归纳为如下几类。1、开关量的逻辑控制这是 PLC 最基本、最广泛的应用领域，它取代传统的继电器电路，实现逻辑控制、顺序控制，既可用于单台设备的控制，也可用于多机群控及自动化流水线。如注塑机、印刷机、订书机械、组合机床、磨床、包装生产线、电镀流水线等。2、模拟量控制在工业生产过程当中，有许多连续变化的量，如温度、压力、流量、液

20、位和速度等都是模拟量。为了使可编程控制器处理模拟量，必须实现模拟量（Analog）和数字量（Digital）之间的 A/D 转换及 D/A 转换。PLC 厂家都生产配套的 A/D 和 D/A 转换模块，使可编程控制器用于模拟量控制。3、运动控制PLC 可以用于圆周运动或直线运动的控制。从控制机构配置来说，早期直接用于开关量 I/O 模块连接位置传感器和执行机构，现在一般使用专用的运动控制模块。如可驱动步进电机或伺服电机的单轴或多轴位置控制模块。世界上各主要PLC 厂家的产品几乎都有运动控制功能，广泛用于各种机械、机床、机器人、电梯等场合。4、过程控制过程控制是指对温度、压力、流量等模拟量的闭环

21、控制。作为工业控制计算机，PLC 能编制各种各样的控制算法程序，完成闭环控制。PID 调节是一般闭环控制系统中用得较多的调节方法。大中型 PLC 都有 PID 模块，目前许多小型 PLC 也具有此功能模块。PID 处理一般是运行专用的 PID 子程序。过程控制在冶金、化工、热处理、锅炉控制等场合有非常广泛的应用。5、数据处理现代 PLC 具有数学运算（含矩阵运算、函数运算、逻辑运算）、数据传送、11数据转换、排序、查表、位操作等功能，可以完成数据的采集、分析及处理。这些数据可以与存储在存储器中的参考值比较，完成一定的控制操作，也可以利用通信功能传送到别的智能装置，或将它们打印制表。数据处理一般

22、用于大型控制系统，如无人控制的柔性制造系统；也可用于过程控制系统，如造纸、冶金、食品工业中的一些大型控制系统。6、通信及联网PLC 通信含 PLC 间的通信及 PLC 与其它智能设备间的通信。随着计算机控制的发展，工厂自动化网络发展得很快，各 PLC 厂商都十分重视 PLC 的通信功能,纷纷推出各自的网络系统。新近生产的 PLC 都具有通信接口，通信非常方便。基于 PLC 的机械手控制系统设计123机械手的设计3.1 机械手的控制要求本机械手的控制要求：机械手搬运零部件动作示意图如下图 3-1 所示，该机械手可用来将工件从 A 工位搬到 B 工位，实现方式有手动自动两种工作方式，其动作过程分为

23、 10 工步，即从原位开始顺序经过 10 个动作后完成一个周期，并返回原位，在此，定义机械手处于左旋限位，上行限位时为原点。具体过程是：横轴下降，至下限位开关，夹紧工件，横轴上升，至上限位开关，底盘右旋转，至右旋限位开关，横轴右行，至右限位开关，横轴下降，至下限位开关松开工件，横轴上升，至上限位开关，横轴左行，至左限位开关，底盘左旋转至左旋限位开关，返回原位，完成一个周期。为了便于控制系统调试和维护，本控制系统有手动功能和自动功能。当手动/自动转换开关置于“手动”位置时，按下相应的手动按钮，就可实现上升、下降、左移、右移、夹紧、放松的手动控制。当机械手处于原位时，将手动/自动转换开关置于“自动

24、”位置时，进入自动工作状态。机械手工作方式说明如下：（1）手动工作方式即单步运行，每按一个按钮，执行一步操作；（2）自动工作方式即连续运行，按下启动按钮，机械手自动运行，一个周期后循环工作，直至完成搬运任务；（3）运行之前，通常对机械手进行复位操作，复位操作有机械手在左边、在右边、在中间三种情况，要逐一考虑，使机械手在任意位置都可以完成复位回到原点；（4）运行过程中，当按下停止按钮时，要停止一切动作。13I一P降电机降电机左右行旦机,穿3、7左旋转左旋转图 3-1机械手搬运零部件示意图Fig.3-1Manipulatorhandlingpartsschemes3.2 机械手控制系统设计方案的比

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

26、制系统，这更是它的优势。本系统的开关量输入信号为数字信号，直接连接 PLC,PLC 通过中间继电器对电磁阀加以控制。系统框图如图 3-2 所示。图 3-2系统框图Fig.3-2Thesystemframe4系统硬件电路的设计4.1 PLC 的选型目前，世界上有 200 多个厂家生产可编程控制器产品，比较著名的 PLC 生产厂家主要有美国的 AB、通用（GE）、日本的三菱（MITSBISHI）、欧姆龙（OMRON） 、德国的西门子（SIMENS）法国的 TE、韩国的三星（SUMSUNG）LG 等。本文选择的是德国西门子公司生产的 S7-200PLC。S7-200 系列 PLC 是西门子公司生产的

27、一种小型 PLC，其许多功能达到大、中型 PLC 的水平，而价格却和小型右行步进二 左右行电机驱动器步进步进电机电机上下上下; ;亍亍 n n 步进步进电札匕电札匕15PLC 的一样，因此它一经推出，即受到了广泛的关注。特别是 S7-200CPU22*系列PLC，由于它具有多种功能模块和人机界面（HMI）可供选择，所以系统的集成非常方便，并且可以很容易地组成 PLC 网络。同时它具有功能齐全的编程和工业控制组态软件，使得在完成控制系统的设计时更加简单，其速度快，具有极强的通信能力，几乎可以完成任何功能的控制任务。根据机械手的控制要求，PLC 输入、输出点分配如表所示：表表 4-14-1PLCP

28、LC 的的 I/OI/O 分配表分配表Tab.Tab.4-14-1PLCofI/OdistributionlistPLCofI/Odistributionlist名称名称输入输入名称名称输入输入启动按钮SB1I0.0夹紧按钮SB10I1.1停止按钮SB2I0.1松开按钮SB11I1.2复位按钮SB3I0.2上升限位开关SQ1I1.3上升按钮SB4I0.3下降限位开关SQ2I1.4下降按钮SB5I0.4左行限位开关SQ3I1.5左行按钮SB6I0.5右行限位开关SQ4I1.6右行按钮SB7I0.6左旋限位开关SQ5I1.7左旋按钮SB8I0.7右旋限位开关SQ6I2.0右旋按钮SB9I1.0名称

29、名称输出输出名称名称输出输出上下行步进电机驱动器脉冲输入Q0.0基座电机正转Q0.4左右行步进电机驱动器脉冲输入Q0.1基座电机反转Q0.5上下行步进电机驱动器方向输入Q0.2松紧电磁阀Q0.6左右行步进电机驱动器方向输入Q0.3原位指示灯Q0.7由上表可知，该控制系统共需要 17 个输入点，8 个输出点，此处选用西门子公司基于 PLC 的机械手控制系统设计16生产的小型 PLCS7-200 系列的 CPU226 继电器输出型可编程控制器，该控制器输入点24个，输出点16个。4.2 机械手驱动的选择机械手的全部动作由步进电机和直流电机进行驱动控制。步进电机的运动需要驱动器，有脉冲输入时步进电机

30、才会动作，且每当脉冲由低变高时步进电机走一步；改变电机转向时，需要加方向信号。机械手的上升/下降、左行/右行动作就是通过控制这两个步进电机的正反转来实现的。基座旋转是通过控制直流电机的转动方向来实现的。机械手的放松/夹紧由一个单线圈两位置电磁阀控制。当该线圈通电时，机械手放松；该线圈断电时，机械手夹紧。4.2.1 步进电机步进电机步进电机是将电脉冲信号转变为角位移或线位移的开环控制元件。通俗一点讲：当步进驱动器接收到一个脉冲信号，它就驱动步进电机按设定的方向转动一个固定的角度（即步距角）。通过控制脉冲个数来控制角位移量，从而达到准确定位的目的；同时也可以通过控制脉冲频率来控制电机转动的速度和加

31、速度，从而达到调速的目的。本系统采用二相八拍混合式步进电机来控制机械手的动作，相比直流电机有更好的制动效果，又加上滚珠丝杆和滑杆配合，使机械手的运动更加稳定。主要特点：体积小，具有较高的起动和运行频率，有定位转矩等优点。此处采用串联型接法，其电气接线图如下图 4-1 所示。步进电机的运行要有一电子装置进行驱动,这种装置就是步进电机驱动器,17它是把控制系统发出的脉冲信号转化为步进电机的角位移，或者说：控制系统每发一个脉冲信号，通过驱动器就使步进电机旋转一步距角。所以步进电机的转速与脉冲信号的频率成正比。红蓝白棕B+B-图 4-1步进电机电气接线图Fig.4-1Stepmotorelectric

32、alhookup4.2.2 步进电机的选择步进电机的选择步进电机有步距角（涉及到相数）、静转矩、及电流三大要素组成。一旦三大要素确定，步进电机的型号便确定下来了。1、步距角的选择电机的步距角取决于负载精度的要求，将负载的最小分辨率（当量）换算到电机轴上，每个当量电机应走多少角度（包括减速）。电机的步距角应等于或小于此角度。目前市场上步进电机的步距角一般有 0.36 度/0.72 度（五相电机）、0.9 度/1.8 度（二、四相电机）、1.5 度/3 度（三相电机）等。2、静力矩的选择步进电机的动态力矩一下子很难确定，我们往往先确定电机的静力矩。静力矩选择的依据是电机工作的负载，而负载可分为惯性

33、负载和摩擦负载二种。单一的惯性负载和单一的摩擦负载是不存在的。直接起动时（一般为低速）二种负载均要考虑，加速起动时主要考虑惯性负载，恒速运行进只要考虑摩擦负载。一般情况下，静力矩应为摩擦负载的 2-3 倍最好，静力矩一旦选定，电机的机座及长度便能确定下来（几何尺寸）基于 PLC 的机械手控制系统设计183、电流的选择静力矩一样的电机，由于电流参数不同，其运行特性差别很大，可依据矩频特性曲线图，判断电机的电流（参考驱动电源、及驱动电压）。4、力矩与功率换算步进电机一般在较大范围内调速使用、其功率是变化的，一般只用力矩来衡量，力矩与功率换算如下：P=Q=2nn/60P=2nnM/60 其 P 为功

34、率，单位为瓦；Q为每秒角速度，单位为弧度；n 为每分钟转速；M 为力矩，单位为牛顿 米；P=2nfM/400（半步工作），其中 f 为每秒脉冲数（简称 PPS）。此外，在选取电机时，我们应该注意：1、步进电机应用于低速场合-每分钟转速不超过 1000 转，（0.9 度时3000PPS），最好在 1000-3000PPS（0.9 度）间使用，可通过减速装置使其在此间工作，此时电机工作效率高，噪音低。2、步进电机最好不使用整步状态，整步状态时振动大。3、电机在较高速或大惯量负载时，一般不在工作速度起动，而采用逐渐升频提速，一是可以保证电机不失步，二可以减少噪音同时可以提高停止的定位精度。4、电机在

35、 600PPS（0.9 度）以下工作，应采用小电流、大电感、低电压来驱动。5、应遵循先选电机后选驱动的原则。根据以上原则， 我们选用深圳雷塞两相 57HS13 系列步进电机， 电机参数为：表表 4-24-2 步进电机参数表步进电机参数表Tab.Tab.4-24-2StepmotorparametertableStepmotorparametertable型号型号静力静力矩矩（NM）歩距角歩距角（）相电流相电流離3电感电感(mH)长度长度L(mm)转子惯转子惯量量（g重量重量(Kg)串联串联（A）并联并联（A）57HS1357HS131.31.31.81.82.02.04.04.01.01.02

36、.12.176764604601.01.0选用雷塞两相 M860 系列步进电机驱动器，工作电流 2.47.2A，工作电压2480V。4.3 PLC 原理接线图19根据PLC的选型、 输入/输出端口分布表以及步进电机和步进电机驱动器类型，画出 PLC 的外部接线图，如下：+24V图 4-2PLC外部接线图Fig.4-2PLCexternalhookup基于 PLC 的机械手控制系统设计205控制系统软件设计本控制系统，我们选取自动和手动两种工作方式，手动控制方式即单步运行方式，手动操作不需要按工序顺序动作，可以按普通继电器接触器控制系统来设计，利用按钮对机械手每一动作单独进行控制，如按“下降”按

37、钮，机械手下降；按“上升”按钮，机械手上升。而自动工作方式，按下启动按钮后，机械手从原点开始按工序自动反复连续循环工作，直到按下停止按钮，机械手自动停机。自动控制系统的整体运行情况是：打开电源，按下起动按钮时，开机复位机械手的动作示意图如图 3-1 所示。机械手若不在原点则 PLC 向上下行驱动器输入脉冲信号，上下行步进电机正转，机械手上升。上升到底时碰到上限位开关，然后主机向左右行驱动器同时输入脉冲信号和电平信号，左右行步进电机反转，横轴左行。当行进到位时碰到左限位开关，左行停止，回到原点。主机向上下行驱动器同时输入脉冲信号和电平信号，上下行步进电机反转，机械手下降。降到底时碰到下限位开关，

38、下降停止，夹紧电磁阀断电，机械手夹紧。夹紧后，主机向上下行驱动器只输入脉冲信号，上下行步进电机正转，机械手上升。上升到顶时，碰到上限位开关，上升停止。PLC 向基座电机输入正转信号，电机正转，机械手右旋，碰到右旋限位开关，右旋停止。主机向左右行驱动器输入脉冲信号电平信号，步进电机左右行正转，机械手右行，右行到位时，碰到右限位开关，右行停止。主机向上下行驱动器同时输入脉冲信号和电平信号，上下行步进电机反转，机械手下降。降到底时碰到下限位开关，下降停止，同时夹紧电磁阀得电，机械手放松。放松后，主机向驱动器上下行输入脉冲信号上下行步进电机正转，机械手上升，上升到顶时，碰到上限位开关，上升停止 PLC

39、 向左右行驱动器同时输入脉冲信号和电平信号，左右行步进电机反转，横轴左行，当左行到底时碰到左限位开关，然后主机向基座电机同时输入反转信号，电机反转，机械手左旋，碰到左旋限位开关左旋停止，回到原点。至此，机械手经过十步动作完成一个循环。就此给出自动控制系统的功能流程图和系统整体的 PLC 程序。5.1 控制系统功能流程21JL电后原位扌旨不灯壳下降抓紧延时10S上升右旋右行下降松开延时10s二升左行左旋图 5-1控制系统功能流程图Fig.5-1Controlsystemfunctionflowchart基于 PLC 的机械手控制系统设计225.2 PLC 编程与调试5.2.1 手动控制程序手动控

40、制程序手动控制即单步运行，当按下一个按钮，比如说上升按钮，机械手自动上升，什么时候停下来则由限位开关来决定。根据这一思路，编写如下程序：IPROGRMCO屈MENT5Nctwcilc1Nethscrk1iHe丨上引丨IQ3Q0.2Qi：U：i-Network2rawNtwoik3IQ4QO.DQ0.2II1I(b)23基于 PLC 的机械手控制系统设计245.2.2 复位控制程序复位控制程序复位程序比较复杂，因为机械手为三自由度，十个工步，所以有三种情况:在左边任意位置，在右边任意位置，既不在左边又不在右边而是在中间的任意位置。所以按下复位按钮时我们需要首先判断机械手的确切位置。在这里，我们可

41、以通过限位开关和松紧电磁阀的状态明确的判断出来。找到机械手的具体位置，就可以驱动机械手进行下一步动作。比如机械手在右边，而且手部没有货物，那么右行限位开关和电磁阀都应该是闭合的，机械手下一步要完成的动作是放松上升，左移至左行限位开关再左旋，然后回到原点，完成复位工作。在左边和在中间时，也是如此。根据这一思路，编写如下程序：|冷讣绷1111计1曲七Nelwuik1 复应程序|允许鱷回匾点TI:盯Nctwoik2启动回原点M1.2机樋手住边弭加搭升 2 罰.列 2FM1.311.5Q06S12|FPRl)OOC31.3.|ccm)Natwoik7I机械手在中间创丄放也左移即.映紧右着II.Q0.G

42、1ICQ0.6MI(si/DLHQ=;hJnlwnik3.至直理）屮皓丸Nclwoik9夹紧上升FI3Nelwuik10mm- -Network11上耳到 f 立启动夹紧右移113S15|ocnr)M1.211.53C.0-)-)基于 PLC 的机械手控制系统设计2627Network2011.4Q0.1Q0.1IhICn)1Network21|下睢刘住松开征时1应卜Network22I时问到启动放松上升K731.0|5)Netwoik23基于 PLC 的机械手控制系统设计28HMoik24|讹上升S1.0SCR_NetHoik2511.3Q00QLLOMN|(R)1tlBtwaik26I上井

43、到位放世左務11.3hl2VII1I：L)29Network34上升甄门1IU3QQ.D1/1IC=)QQ011、1(-)1Nletwnrik35:I.1:|)基于 PLC 的机械手控制系统设计305.2.3 自动控制程序自动控制程序自动控制即连续控制，按下启动按钮，检测机械手是否在原点，若不在,首先复位，若在则依次完成十个工步，直到按下停止按钮。程序如下：Ne|mh1 目动运厅程序113117QDGMI.711TIT-INelwurk2若不确点启动溟位子程厚IDOM0.7SBR_O1111ENHetwork3但怔后启动自訪话行理序nov0.7IC.1Ml.2II.1111111kJM0.2IIMelwnrk 曲启动下阵程序Mfilwnrk7I下降到世启动夹蘇帚/ML.2S21Nelwuik0NIflNIflWDWDI-kI-kg g52521 1 -J-JMWOIk_二2 2Jt_lJt_lUJUJ1TnA3zl;IFzl;IF1LU1LU7 7zzWCIkzt审些lapl型IHI屮臨