基于PLC的机械手臂设计.docx

1、基于PLC的机械手臂设计基于PLC的机械手臂设计摘 要机械手是工业机器人系统中传统的任务执行机构，是机器人的关键部件之一。机械手的机械结构采用滚珠丝杆、滑杆、等机械器件组成；电气方面有交流电机、变频器、传感器、等电子器件组成。该装置涵盖了可编程控制技术，位置控制技术、检测技术等，是机电一体化的典型代表仪器之一。本毕业设计介绍的机械手是由PLC输出三路脉冲，分别驱动横轴、竖轴变频器，控制机械手横轴和竖轴的精确定位，微动开关将位置信号传给PLC主机；位置信号由接近开关反馈给PLC主机，通过交流电机的正反转来控制机械手手爪的张合，从而实现机械手精确运动的功能。本课题拟开发的物料搬运机械手可在空间抓放

2、物体，动作灵活多样，可代替人工在高温和危险的作业区进行作业，并可根据工件的变化及运动流程的要求随时更改相关参数机械手是能够模仿人手动作，并按设定程序、轨迹和要求代替人手抓（吸）取、搬运工件或工具或进行操作的自动化装置，它能部分的代替人的手工劳动。较高级型式的机械手，还能模拟人的手臂动作，完成较复杂的作业。在机械制造业中，机械手已被广泛应用，从而大大地改善了工人的劳动条件，显著的提高劳动生产率，加快实现工业生产机械化和自动化的步伐。在我国，工业机械手近年来有较快的发展，投入了大量的人力物力加以研究和应用，并且很好的效果。本课题主要研究的问题是近距离自动移动式机械手臂设计-气压驱动式。设计包括两大

3、方面，其中之一是自动行走部分，另一部分为手臂的运转。采用同一驱动能源-气泵。行走部分可以采用气压马达带动两轮转动。气压泵固定在某处，用一根软管将泵与马达相连，马达安装在行走装置中。运动手臂的直线运动用气缸来实现，旋转运动用气压马达来实现。行走的时候手臂不动，手臂运动的时候，行走部分停止运动。关键字：机械手，PLC，自动化，可编程控制器引 言在现代工业中，生产过程的机械化、自动化已成为突出的主题。随着工业现代化的进一步发展,自动化已经成为现代企业中的重要支柱,无人车间、无人生产流水线等等，已经随处可见。同时，现代生产中，存在着各种各样的生产环境，如高温、放射性、有毒气体、有害气体场合以及水下作业

4、等，这些恶劣的生产环境不利于人工进行操作。工业机械手是近代自动控制领域中出现的一项新的技术，是现代控制理论与工业生产自动化实践相结合的产物，并以成为现代机械制造生产系统中的一个重要组成部分。工业机械手是提高生产过程自动化、改善劳动条件、提高产品质量和生产效率的有效手段之一。尤其在高温、高压、粉尘、噪声以及带有放射性和污染的场合，应用得更为广泛。在我国，近几年来也有较快的发展，并取得一定的效果，受到机械工业和铁路工业部门的重视。本课题拟开发物料搬运机械手，采用日本三菱公司的FX2N系列PLC，对机械手的上下、左右以及抓取运动进行控制。该装置机械部分有滚珠丝杠、滑轨、机械抓手等；电气方面由交流电机

5、、变频器、操作台等部件组成。我们利用可编程技术，结合相应的硬件装置，控制机械手完成各种动作。由于时间仓促和个人水平限制，我的设计存在着许多还没来得及解决的问题，希望广大老师、同学能够给予批评指正并予以解决。第一章 机械手机械结构1.1 传动机构1.1.1 螺旋机构螺旋机构由螺杆、螺母和机架组成，其主要功能是将转动变换为直线运动，并同时传递运动和动力，按螺旋副中的摩擦性质，螺旋机构可以分为滑动螺旋机构和滚动螺旋机构两种类型。按用途可以分为传力螺旋、传导螺旋和调整螺旋三种类型。螺旋机构具有结构简单，制造方便，传动平稳，无噪声易于自锁等优点。1.1.2 滑动螺旋机构螺旋副内为滑动摩擦的的螺旋机构，称

6、为滑动螺旋机构。滑动螺旋机构所用的螺纹为传动性能好，效率高的矩形、梯形和锯齿形螺纹。滑动螺旋机构由螺母和螺杆组成。根据机构的组成及运动方式，滑动螺旋机构又分为以下两种。由螺母和螺杆组成的滑动螺旋机构，螺母与机架固联，螺杆转动并移动，这种螺旋机构以传递动力为主，故又称传力螺旋机构。一般要求用较小的转矩产生较大的轴向力，多用在工作时间短，速度较低的场合。由螺母、螺杆和机架组成的滑动螺旋机构，螺杆转动，螺母移动，这种螺旋机构以传递运动为主，故又称为传导螺旋机构。本文所介绍的机械手的竖轴就是用的传导螺旋机构。这种传动形式结构紧凑，刚度较大，传动效率高，精度高。1.1.3 滚动螺旋机构螺旋副内为滚动摩擦

7、的螺旋机构，称为滚动螺旋机构或滚珠丝杠。其机构特点是在螺杆和螺母之间设有封闭循环滚道，并在其间放如刚球，当螺杆转动时，刚球沿螺旋滚道滚动并带动螺母作直线运动。按循环方式的不同，分为外循环和内循环两种形式。滚珠始终在循环过程中始终与螺杆保持接触的循环叫内循环。滚珠在返回时与螺杆脱离接触的循环叫外循环。外循环螺母只需设置一个反向器，当滚珠进入反向器时，就被阻止而转弯，从返回通道回到滚道的另一端，形成一个循环回路。机械手的横向运动采用的便是滚动螺旋传动。滚动螺旋机构摩擦阻力小，动作灵敏度高，传动效率高，可达90%以上。用调整的方法可消除间隙，传动精度高。1,2 机械手夹持器和机座的结构1.2.1 机

8、械手夹持器机械手的机械夹持器多为双指手抓式，按其手抓的运动方式可分为平移型和回转型。回转型手抓有可分为单支点和双支点回转型，按夹持方式可以分为外夹式和内撑式。按驱动方式可以电动、液压和气动三种。回转型夹持器结构较简单，但当所夹持的工件直径有变动时，将引起工件轴心的偏移。对平移型夹持器，工件直径的变化不影响其轴心的位置。但其机械机构繁杂，体积大，制造精度要求高。所以当设计机械手夹持器的时候，在满足工件的定位精度要求的条件下，尽可能的采用结构比较简单回转型夹持器。 图1.1机械手夹持器本文设计的机械手采用的是楔槽杠杆式回转型夹持器。如右图所示，装在杆上端的滚子3和楔块之间为滚动接触。当电机带动连杆

9、前进时，通过楔块4的斜面和杠杆1，使两个手抓产生加紧动作和加紧力。当楔块后移时，靠弹簧的拉力使手指松开。这种末端执行器由于楔块和滚子之间为滚动接触，摩擦力小，活动灵活，且机构简单。1.2.2 机座机座是机械手的支撑部件，机座承受机械手的全部重量和工作载荷，所以机座应有足够的强度、刚度和承载能力。另外机座还要求有足够大的安装基面，以保证机械手工作时的稳定行。 机械手采用普通轴承作为支撑元件的机座支撑结构。这种结构有制造简单、成本低、安装调整方便等优点。图中电动机3经减速器4、主动小齿轮5、中间齿轮6、大齿轮7驱动丝杆2旋转，从而驱动升降台上下运动。整个机座安装在基座8上。第二章 可编程控制PLC

10、的选择2.1 PLC简介自二十世纪六十年代美国推出可编程逻辑控制器（Programmable Logic Controller，PLC）取代传统继电器控制装置以来，PLC得到了快速发展，在世界各地得到了广泛应用。同时，PLC的功能也不断完善。随着计算机技术、信号处理技术、控制技术网络技术的不断发展和用户需求的不断提高，PLC在开关量处理的基础上增加了模拟量处理和运动控制等功能。今天的PLC不再局限于逻辑控制，在运动控制、过程控制等领域也发挥着十分重要的作用。作为离散控的制的首选产品，PLC在二十世纪八十年代至九十年代得到了迅速发展，世界范围内的PLC年增长率保持为20%30%。随着工厂自动化程

11、度的不断提高和PLC市场容量基数的不断扩大，近年来PLC在工业发达国家的增长速度放缓。但是，在中国等发展中国家PLC的增长十分迅速。综合相关资料，2004年全球PLC的销售收入为100亿美元左右，在自动化领域占据着十分重要的位置。 PLC是由摸仿原继电器控制原理发展起来的，二十世纪七十年代的PLC只有开关量逻辑控制，首先应用的是汽车制造行业。它以存储执行逻辑运算、顺序控制、定时、计数和运算等操作的指令；并通过数字输入和输出操作，来控制各类机械或生产过程。用户编制的控制程序表达了生产过程的工艺要求，并事先存入PLC的用户程序存储器中。运行时按存储程序的内容逐条执行，以完成工艺流程要求的操作。PL

12、C的CPU内有指示程序步存储地址的程序计数器，在程序运行过程中，每执行一步该计数器自动加1，程序从起始步（步序号为零）起依次执行到最终步（通常为END指令），然后再返回起始步循环运算。PLC每完成一次循环操作所需的时间称为一个扫描周期。不同型号的PLC，循环扫描周期在1微秒到几十微秒之间。PLC用梯形图编程，在解算逻辑方面，表现出快速的优点，在微秒量级，解算1K逻辑程序不到1毫秒。它把所有的输入都当成开关量来处理，16位（也有32位的）为一个模拟量。大型PLC使用另外一个CPU来完成模拟量的运算。把计算结果送给PLC的控制器。相同I/O点数的系统，用PLC比用DCS，其成本要低一些（大约能省4

13、0%左右）。PLC没有专用操作站，它用的软件和硬件都是通用的，所以维护成本比DCS要低很多。一个PLC的控制器，可以接收几千个I/O点（最多可达8000多个I/O）。如果被控对象主要是设备连锁、回路很少，采用PLC较为合适。PLC由于采用通用监控软件，在设计企业的管理信息系统方面，要容易一些。 近10年来，随着PLC价格的不断降低和用户需求的不断扩大，越来越多的中小设备开始采用PLC进行控制，PLC在我国的应用增长十分迅速。随着中国经济的高速发展和基础自动化水平的不断提高，今后一段时期内PLC在我国仍将保持高速增长势头。 通用PLC应用于专用设备时可以认为它就是一个嵌入式控制器，但PLC相对一

14、般嵌入式控制器而方具有更高的可靠性和更好的稳定性。实际工作中碰到的一些用户原来采用嵌入式控制器，现在正逐步用通用PLC或定制PLC取代嵌入式控制2.2 PLC内部原理2.2.1 中央处理单元（CPU）中央处理单元（CPU）是PLC 的控制中枢。它按照PLC系统程序赋予的功能，接受并存储从编程器键入的用户程序和数据，检查电源、存储器、I/O以及警戒定时器的状态，并能检查用户程序的语法错误。当PLC投入运行时，首先它以扫描的方式接受现场各输入装置的状态和数据，并分别存入I/O映象区, 然后从用户程序存储器中逐条读取用户程序，经过命令解释后按指令的规定执行逻辑或算术运算等任务。并将逻辑或算术运算等结

15、果送入I/O映象区或数据寄存器内。等所有的用户程序执行完毕以后，最后将I/O映象区的各输出状态或输出寄存器内的数据传送到相应的输出装置，如此循环运行，直到停止运行为止。2.2.2 存储器与微型计算机一样，除了硬件以外，还必须有软件。才能构成一台完整的PLC。PLC的软件分为两部分: 系统软件和应用软件。存放系统软件的存储器称为系统程序存储器。PLC存储空间的分配：虽然大、中、小型 PLC的CPU的最大可寻址存储空间各不相同，但是根据PLC的工作原理， 其存储空间一般包括以下三个区域：系统程序存储区，系统RAM存储区（包括I/O映象区和系统软设备等）和用户程序存储区。系统程序存储区：在系统程序存

16、储区中存放着相当于计算机操作系统的系统程序。它包括监控程序、管理程序、命令解释程序、功能子程序、系统诊断程序等。由制造厂商将其固化在EPROM中，用户不能够直接存取。它和硬件一起决定了该PLC的各项功能。系统RAM存储区：系统RAM存储区包括I/O映象区以及各类软设备（例如：逻辑线圈、数据寄存器、计时器、计数器、变址寄存器、累加器等）存储区。2.2.3 I/O映象区由于PLC投入运行后，只是在输入采样阶段才依次读入各输入状态和数据，在输出刷新阶段才将输出的状态和数据送至相应的外设。因此，它需要有一定数量的存储单元（RAM）以供存放I/O的状态和数据，这些存储单元称作I/O映象区。一个开关量I/

17、O占用存储单元中的一个位（bit）, 一个模拟量I/O占用存储单元中的一个字（16个bit)。因此，整个I/O映象区可看作由开关量的I/O映象区和模拟量的I/O映象区两部分组成。2.2.4 系统软设备存储区除了I/O映象区以外，系统 RAM存储区还包括PLC内部各类软设备（逻辑线圈、数据寄存器、计时器、计数器、变址寄存器、累加器等）的存储区。该存储区又分为具有失电保持的存储区域和无失电保持的存储区域，前者在PLC断电时，由内部的锂电子供电。使这部分存储单元内的数据得以保留；后者当PLC停止运行时，将这部分存储单元内的数据全部置“零”。2.2.5 用户程序存储区 用户程序存储区存放用户编制的用户

18、程序。不同类型的PLC其存储容量各不相同，一般来说，随着PLC机型增大其存储容量也相应增大。不过对于新型的PLC，其存储容量可根据用户的需要而改。2.2.6 常用的I/O分类常用的I/O分类如下：开关量：按电压水平分，有220VAC、110VAC、24VDC，按隔离方式分，有继电器隔离和晶体管隔离。模拟量：按信号类型分，有电流型（4-20mA,0-20mA）、电压型（0-10V,0-5V,-10-10V）等，按精度分，有12bit,14bit,16bit等。除了上述通用I/O外，还有特殊I/O模块，如热电阻、热电偶、脉冲等模块。按I/O点数确定模块规格及数量，I/O模块可多可少，但其最大数受C

19、PU所能管理的基本配置的能力，即受最大的底板或机架槽数限制。2.3 PLC的工作原理可编程序控制器有两种基本的工作状态，即运行（RUN）状态与停止（STOP）状态。在运行状态，可编程控制器通过执行反映控制要求的用户程序来实现控制功能。为了使可编程序控制器的输出及时地响应随时可能变化的输入信号，用户程序不是只执行一次，而是反复不断地重复执行，直至可编程序控制器停机 或切换到STOP工作状态。除了执行用户程序之外，在每次循环过程中，可如上图编程序控制器还要完成，内部处理、通信处理等工作，一次循环可分为5个阶段。可编程序控制器的这种周而复始的循环工作方式称为扫描工作方式。由于计算机执行指令的速度极高

20、，从外部输入-输出关系来看，处理过程似乎是同时完成的。在内部处理联合阶段。可编程序控制器检查CPU模块内部的硬件是否正常，将监控定时器复位，以及完成一些别的内部工作。在通信服务阶段，可编程序控制器与别的带微处理器的智能装置通信，响应编程器键入的命令，更新编程器的显示内容。当可编程序控制器处于停止（STOP）状态时，只执行以上的操作。可编程序控制起处于（RUN）状态时，还要完成另外3个阶段的操作。在可编程序控制器的存储器中，设置了一片区域用来存放输入信号和输出信号的状态，它们分别称为输入映像寄存器和输出映像寄存器。可编程序控制器梯形图中别的编程元件也有对应的映像存储区，它们统称为元件映像寄存器。

21、在输入处理阶段，可编程序控制器把所有外部输入电路的接通/断开（ON/OFF）状态读入输入寄存器。外接的输入触点电路接通时，对应的输入映像寄存器为“1”状态，梯形图中对应的输入继电器的常开触点接通，常闭触点断开。外接的输入触点电路断开，对应的输入映像寄存器为“0”状态，梯形图中对应的输入继电器的常开触点断开，常闭触点接通。在程序执行阶段，即使外部输入信号的状态发生了变化，输入映像寄存器的状态 也不会随之而变，输入信号变化了的状态只能在下一个扫描周期的输入处理阶段被读入。可编程序控制器的用户程序由若干条指令组成，指令在存储器中按步序号顺序排列。在没有跳转指令时，CPU从第一条指令开始，逐条顺序的执

22、行用户程序，直到用户程序结束之处。在执行指令时，从输入映像寄存器或别的元件映像寄存器中将有关编程元件的0/1状态读出来，并根据指令的要求执行相应的逻辑运算，运算结果写入到对应的元件映像寄存器中，因此，各编程元件的映像寄存器（输入映像寄存器除外）的内容随着程序的执行而变化。在输出处理阶段，CPU 将输出映像寄存器的0/1状态传送到输出锁存器。体型图某一输出继电器的线圈“通电”时，对应的输出映像寄存器为“1”状态。信号经输出模块隔离 和功率放大后，继电器型输出模块中对应的硬件继电器的线圈通电，其常开触点闭合，使外部负载通电工作。若梯形图中输出继电器线圈断电对应的输出映像寄存器为“0”状态，在输出处

23、理阶段后，继电器型输出模块中对应的硬件继电器的线圈断电，其常开触点断开，外部负载断电，停止工作。某一编程元件对应的映像寄存器为“1”状态时，称该编程元件为ON，映像寄存器为“0”状态时，称该编程元件为OFF。扫描周期可编程序控制器在RUN工作状态时，执行一次图2.1所示的扫描操作所需的时间称为扫描周期，其典型值为1100ms。指令执行所需的时间与用户程序的长短、指令的种类和CPU执行指令的速度有很大的关系。当用户程序较长时，指令执行时间在扫描周期中占相当大的比例。不过严格地来说扫描周期还包括自诊断、通信等。如图2.1所示。图2.1 PLC的扫描运行方式2.3.1 输入采样阶段在输入采样阶段，P

24、LC以扫描方式依次读入所有的数据和状态它们存入I/O映象区的相应单元内。输入采样结束后，转入用户程序行和输出刷新阶段。在这两个阶段中，即使输入数据和状态发生变化I/O映象区的相应单元的数据和状态也不会改变。所以输入如果是脉冲信号，它的宽度必须大于一个扫描周期，才能保证在任何情况下，该输入均能被读入。2.3.2 用户程序执行阶段在用户程序执行阶段，PLC的CPU总是由上而下，从左到右的顺序依次的扫描梯形图。并对控制线路进行逻辑运算，并以此刷新该逻辑线圈或输出线圈在系统RAM存储区中对应位的状态。或者确定是否要执行该梯形图所规定的特殊功能指令。例如：算术运算、数据处理、数据传达等。2.3.3 输出

25、刷新阶段在输出刷新阶段，CPU按照I/O映象区内对应的数据和状态刷新所有的数据锁存电路，再经输出电路驱动响应的外设。这时才是PLC真正的输出。2.3.4 输入/输出滞后时间输入/输出滞后时间又称系统响应时间，是指可编程序控制器的外部输入信号发生变化的时刻至它控制的有关外部输出信号发生变化的时刻之间的时间间隔，它由输入电路滤波时间、输出电路的滞后时间和因扫描工作方式产生的滞后时间三部分组成。输入模块的CPU滤波电路用来滤除由输入端引入的干扰噪声，消除因外接输入触点动作是产生的抖动引起的不良影响，滤波电路的时间常数决定了输入滤波时间的长短，其典型值为10ms左右。输出模块的滞后时间与模块的类型有关

26、，继电器型输出电路的滞后时间一般在10ms左右；双向可空硅型输出电路在负载接通时的滞后时间约为1ms，负载由导通到断开时的最大滞后时间为10ms；晶体管型输出电路的滞后时间约为1ms。由扫描工作方式引起的滞后时间最长可达到两个多扫描周期。可编程序控制器总的响应延迟时间一般只有几十ms，对于一般的系统是无关紧要的。要求输入输出信号之间的滞后时间尽量短的系统，可以选用扫描速度快的可编程序控制器或采取其他措施。2.4 PLC机型的选择方法2.4.1 PLC的类型PLC按结构分为整体型和模块型两类，按应用环境分为现场安装和控制室安装两类；按CPU字长分为1位、4位、8位、16位、32位、64位等。从应

27、用角度出发，通常可按控制功能或输入输出点数选型。整体型PLC的I/O点数固定，因此用户选择的余地较小，用于小型控制系统；模块型PLC提供多种I/O卡件或插卡，因此用户可较合理地选择和配置控制系统的I/O点数，功能扩展方便灵活，一般用于大中型控制系统。2.4.2 输入输出模块的选择输入输出模块的选择应考虑与应用要求的统一。例如对输入模块，应考虑信号电平、信号传输距离、信号隔离、信号供电方式等应用要求。对输出模块，应考虑选用的输出模块类型，通常继电器输出模块具有价格低、使用电压范围广、寿命短、响应时间较长等特点；可控硅输出模块适用于开关频繁，电感性低功率因数负荷场合，但价格较贵，过载能力较差。输出

28、模块还有直流输出、交流输出和模拟量输出等，与应用要求应一致。可根据应用要求，合理选用智能型输入输出模块，以便提高控制水平和降低应用成本。考虑是否需要扩展机架或远程I/O机架等。2.4.3 电源的选择PLC的供电电源，除了引进设备时同时引进PLC应根据产品说明书要求设计和选用外，一般PLC的供电电源应设计选用220VAC电源，与国内电网电压一致。重要的应用场合，应采用不间断电源或稳压电源供电。如果PLC本身带有可使用电源时，应核对提供的电流是否满足应用要求，否则应设计外接供电电源。为防止外部高压电源因误操作而引入PLC，对输入和输出信号的隔离是必要的，有时也可采用简单的二极管或熔丝管隔离。2.4

29、.4 经济性的考虑选择PLC时，应考虑性能价格比。考虑经济性时，应同时考虑应用的可扩展性、可操作性、投入产出比等因素，进行比较和兼顾，最终选出较满意的产品。输入输出点数对价格有直接影响。每增加一块输入输出卡件就需增加一定的费用。当点数增加到某一数值后，相应的存储器容量、机架、母板等也要相应增加，估因此，点数的增加对CPU选用、存储器容量、控制功能范围等选择都有影响，在算和选用时应充分考虑，使整个控制系统有较合理的性能价格比。综合上述原则机械手控制系统主机为三菱的FX2N-48MR。2.5 机械手PLC选择及参数2.5.1 主要技术数据如下：工作电源：24VDC输入点数：24输出点数：24输入信

30、号类型：直流或开关量输入电流：24VDC 5mA模拟输入：-10V10V（-20mA+20mA）输出晶体管允许电流0.3A/点（1.2A/COM）输出电压规格：30VDC最大负载：9W输出反应时间：OffOn 20s OnOff 30s基本指令执行时间：数个s程序语言：指令+梯形图+SFC程序容量：3792STEPS基本顺序指令：32个（含步进梯形指令）应用指令：100种初始步进点：S0S9一般步进点：118点，S10S127辅助继电器：一般用512+232点（M000M511+M768M999）停电保持用256点（M512M767）特殊用280点（M1000M1279）定时器：100ms时基

31、64点（T0T63）10ms时基63点（T64T126，M1028为ON时）1ms时基1点（T127）计数器：一般用112点（C000C111，16位计数器）停电保持用16点（C112C127，16位计数器）高速用13点1相5kHz，2相2kHz（C235C254，全部为停电保持32位计数器）数据寄存器：一般用408点（D000D407）停电保持用192点（D408D599）特殊用144点（D1000D1143）指针/中断：P64点；I4点（P0P63/I001、I101、I201、I301）串联通信口：程序写入/读出通讯口：RS232一般功能通讯口：RS485主机电源220V AC2.5.2

32、 PLC主机的组成输入单元：输入单元由8个按扭、8个开关和16个接插件组成，它们分别与PLC的16个输入点相接。改变这些开关或按扭的通断状态，即可对主机输入所需要的开关量。16个接插件可外接其它直流或开关量输入信号。输出单元：输出单元由24个二极管和24个接插件组成，它们分别与PLC的24个输出点相连。发光二极管是否发光，即可表示输出点的状态，使用者可得到主机的输出信息。24个输出接插件可外接其它需要控制的设备。输出单元的4个地端，分别引出到面板，其中只有C4与3V电源共地。电源单元：PLC主机左边有外接220V/AV的电源插座，作为PLC的工作电源。内装变压器，输出3V电源，供二极管使用。另外PLC的24VDC和24GND已引出到面板，供外接输入器件（如传感器）的工作电源用第三章 伺服电机的选择3.1 伺服电机的工作原理伺服电机内