气动机械手回转臂结构设计复习课程

1、气动机械手回转臂结构设计毕业设计气动机械手回转臂结构设计毕业设计任务书题目名称：气动机械手回转臂结构设计具体要求：(原始数据、试验方案、手段及预期结果)结合所学专业知识，查阅相关书籍及资料，深入理解设计课题的要求，完成设计任务，具体要求如下：收集相关资料，气动机械手的工作原理，确定总体设计方案，做开题报告，翻译一篇与该课题有关的不少于 5000个英文字符的外文资料。位置检测精度达到 1毫米。伸缩行程100mm升降行程50mm旋转180。抓握零件直径5 20,最大重量0.5kg。总结设计过程，撰写毕业设计论文，准备答辩，按照论文撰写规范书写 毕业设计论文，并做好答辩前的准备工作 。基本内容如下：

2、本课题将要完成的主要任务如下：(1)进行气动机械手的总体研究，并进行整体运动方式设计；(2)设计气动机械手气路设计，进行关键部件的设计计算；(3)设计气动机械伸缩、回转臂部分结构，进行关键部件的设计计算；(4) PLC 控制系统的设计及编程。其中：参考文献篇10篇以上数：6 000字以上说明书字数：折合A0图纸3张，其中至少1张装配图图纸张数：专业负责人意见签名：年 月日气动机械手回转臂结构设计摘要本文简要介绍了工业机器人的概念，机械手的组成和分类，机械手的自由度和坐标 形式，气动技术的特点，PLC控制的特点及国内外的发展状况。本文对机械手进行总体方案设计，确定了机械手的坐标形式和自由度，确定

3、了机械 手的技术参数。同时，设计了机械手的夹持式手部结构，设计了机械手的手腕结构，计 算出了手腕转动时所需的驱动力矩和回转气缸的驱动力矩。设计了机械手的手臂结构。设计出了机械手的气动系统，绘制了机械手气压系统工作原理图，对气压系统工作 原理图的参数化绘制进行了研究，大大提高了绘图效率和图纸质量。利用可编程序控制器对机械手进行控制，选取了合适的PLC型号，根据机械手的工作流程制定了可编程序控制器的控制方案，设计了机械手的工作时序图，并绘制了可 编程序控制器的控制程序。设计达到了设计的预期目标。关键词 工业机器人；机械手；气动；PLCPneumatic manipulator arm struct

4、ure designAbstractThis paper briefly introduces the concept of industrial robot manipulator, the composition and classification of the manipulator, freedom and coordinates, pneumatic technology of PLC control, the characteristics of the development of both at home and abroad.This paper makes an over

5、all manipulator, the design scheme of the manipulator coordinates and freedom, the technical parameters of the robot. At the same time, the design of clamping manipulator hand structure, the design of the structure of the manipulator wrist, calculates the wrist curls when driving torque and rotary c

6、ylinder driving torque. The design of manipulator arm structure.Design a robot manipulator, pneumatic system, pneumatic system working principle of pneumatic system principle diagram of parameterized drawing was studied, and greatly improve the efficiency of drawing and drawings.Using manipulator pr

7、ogrammable controller, the control of PLC suitable model, according to the working process of the manipulator programmable controller has formulated the control scheme, the work of the manipulator, and draws the sequential diagram PLC control procedures. Design meets the design target.Keywords Indus

8、trial robot; Manipulator ; Air pressure drive; PLC目录摘要 Abstract TOC o 1-5 h z HYPERLINK l bookmark20 o Current Document 1绪论1 HYPERLINK l bookmark22 o Current Document 气动机械手概述 1 HYPERLINK l bookmark24 o Current Document 机械手的组成和分类1 HYPERLINK l bookmark26 o Current Document 机械手的组成1 HYPERLINK l bookmark

9、28 o Current Document 机械手的分类 1 HYPERLINK l bookmark30 o Current Document 国内外发展状况2 HYPERLINK l bookmark32 o Current Document 课题的提出及任务2 HYPERLINK l bookmark34 o Current Document 2机械手的设计方案3 HYPERLINK l bookmark36 o Current Document 机械手的坐标形式与自由度 3 HYPERLINK l bookmark38 o Current Document 机械手的手部结构方案设计3

10、HYPERLINK l bookmark40 o Current Document 机械手的手腕方案设计3 HYPERLINK l bookmark42 o Current Document 机械手驱动方案设计3 HYPERLINK l bookmark44 o Current Document 机械手技术参数列表 3 HYPERLINK l bookmark46 o Current Document 3手腕结构设计5 HYPERLINK l bookmark48 o Current Document 手腕的自由度5 HYPERLINK l bookmark50 o Current Docum

11、ent 手腕的驱动力矩计算5 HYPERLINK l bookmark52 o Current Document 手腕转动时所需要的驱动力矩5 HYPERLINK l bookmark54 o Current Document 4手臂伸缩、升降回转气缸的尺寸计算和校核 8 HYPERLINK l bookmark56 o Current Document 手臂伸缩气缸的尺寸设计与校核8 HYPERLINK l bookmark58 o Current Document 手臂伸缩气缸的尺寸设计 8 HYPERLINK l bookmark60 o Current Document 尺寸校核8 H

12、YPERLINK l bookmark62 o Current Document 导向装置 9 HYPERLINK l bookmark64 o Current Document 平衡装置9 HYPERLINK l bookmark66 o Current Document 手臂升降缸的尺寸设计与校核 9 HYPERLINK l bookmark68 o Current Document 尺寸设计9 HYPERLINK l bookmark70 o Current Document 手臂回转缸的尺寸设计与校核 10 HYPERLINK l bookmark72 o Current Docume

13、nt 尺寸设计10 HYPERLINK l bookmark74 o Current Document 尺寸校核 10 HYPERLINK l bookmark76 o Current Document 5气动系统设计1.1. HYPERLINK l bookmark78 o Current Document 5.1气压传动系统工作原理图 .1.1 HYPERLINK l bookmark80 o Current Document 6机械手的PLC控制13 HYPERLINK l bookmark82 o Current Document 可编程序控制器的选择及工作过程 13 HYPERLIN

14、K l bookmark84 o Current Document 可编程序控制器的选择 13 HYPERLINK l bookmark86 o Current Document 工作过程13 HYPERLINK l bookmark88 o Current Document 机械手可编程序控制器控制方案 13 HYPERLINK l bookmark90 o Current Document 系统简介 13 HYPERLINK l bookmark92 o Current Document 工业机械手的工作流程 14 HYPERLINK l bookmark94 o Current Docu

15、ment 机械手工作时序图 14 HYPERLINK l bookmark96 o Current Document 结论19参考文献201绪论气动机械手概述气动机械手由操作机(机械本体)、控制器、伺服驱动系统和检测传感装置构成，是 一种仿人操作，自动控制、可重复编程、能在三维空间完成各种作业的机电一体化自动 化设备3。它对稳定、提高产品质量，提高生产效率，改善劳动条件和产品的快速更新 换代起着十分重要的作用1。机器人应用情况，是一个国家工业自动化水平的重要标 志。在工业生产中应用的机械手被称为“工业机械手” 4。生产中应用机械手可以提高 生产的自动化水平和劳动生产率：可以减轻劳动强度、保证产

16、品质量、实现安全生产 1 由于通用机械手能很快的改变工作程序，适应性较强，所以它在不断变换生产品种的中 小批量生产中获得广泛的引用。机械手的组成和分类4。各系机械手的组成机械手主要由执行机构、驱动系统、控制系统以及位置检测装置等所组成统相互之间的关系如方框图1-1所示。图1-1机械手组成方框图机械手的分类一、按用途分机械手可分为专用机械手和通用机械手两种4:(1)专用机械手它是附属于主机的、具有固定程序而无独立控制系统的机械装置4。专用机械手具有动作少、工作对象单一、结构简单、使用可靠和造价低等特点1,适用于大批量的自动化生产的自动换刀机械手，如自动机床、自动线的上下料机械手和加工中心3。(2

17、)通用机械手它是一种具有独立控制系统的、程序可变的、动作灵活多样的机械手3。通用机械手的工作范围大、定位精度高、通用性强，适用于不断变换生产品种的中小批量自动化的生产4。二.按驱动方式分(1)液压传动机械手液压传动机械手以液压的压力来驱动执行机构运动的机械手3。其主要特点是：抓重可达几百公斤以上、传动平稳、结构紧凑、动作灵敏1。但对密封装置要求严格，不然油的泄漏对机械手的工作性能有很大的影响，且不宜在高温、低温下工作4。(2)气压传动机械手气压传动机械手以压缩空气的压力来驱动执行机构运动的机械手3。其主要特点是:介质李源极为方便，输出力小，气动动作迅速，结构简单，成本低 1。(3)机械传动机械

18、手机械传动机械手是由机械传动机构(如凸轮、连杆、齿轮和齿条、间歇机构等)驱动的机械手3。它是一种附属于工作主机的专用机械手，其动力是由工作机械传递的 1。国内外发展状况国外机器人领域发展近几年有如下几个趋势：(1)工业机器人性能不断提高(高速度、高精度、高可靠性、便于操作和维修)，而 单机价格不断下降，平均单机价格从 91年的10.3万美元降至97年的65万美元2。(2)机械结构向模块化、可重构化发展。例如关节模块中的伺服电机、减速机、检测系统三位一体化：由关节模块、连杆模块用重组方式构造机器人整机；国外已有模块化装配机器人产品问市。(3)工业机器人控制系统向基于 PC机的开放型控制器方向发展

19、，便于标准化、网 络化；器件集成度提高，控制柜日见小巧，且采用模块化结构；大大提高了系统的可靠 性、易操作性和可维修性。课题的提出及任务进入21世纪，随着我国人口老龄化的提前到来，近来在东南沿海还出现在大量的 缺工现象，迫切要求我们提高劳动生产率，降低工人的劳动强度，提高我国工业自动化 水平势在必行，将机械手，应用于工业自动化生产线，把工业产品从一条生产线搬运到 另外一条生产线，实现自动化生产，减轻产业工人大量的重复性劳动，同时又可以提高 劳动生产率。本课题将要完成的主要任务如下：(1)进行气动机械手的总体研究，并进行整体运动方式设计；(2)设计气动机械手气路设计，进行关键部件的设计计算；(3

20、)设计气动机械伸缩、回转臂部分结构，进行关键部件的设计计算；PLC控制系统的设计及编程。2机械手的设计方案机械手的坐标形式与自由度按机械手手臂的不同运动形式及其组合情况，其座标型式可分为直角座标式、圆柱 座标式、球座标式和关节式3。由于本机械手在上下料时手臂具有升降、收缩及回转运 动，因此，采用圆柱座标型式。相应的机械手具有三个自由度，为了弥补升降运动行程 较小的缺点，增加手臂摆动机构，从而增加一个手臂上下摆动的自由度。机械手的手部结构方案设计为了使机械手的通用性更强，把机械手的手部结构设计成可更换结构，当工件是棒 料时，使用夹持式手部，当工件是板料时，使用气流负压式吸盘。机械手的手腕方案设计

21、考虑到机械手的通用性，同时由于被抓取工件是水平放置，因此手腕必须设有回转 运动才可满足工作的要求。因此，手腕设计成回转结构，实现手腕回转运动的机构为回 转气缸。机械手驱动方案设计由于气压传动系统的动作迅速，反应灵敏，阻力损失和泄漏较小，成本低廉因此本 机械手采用气压传动方式。机械手技术参数列表一用途：用于自动输送线的上下料。二.设计技术参数：(1)抓重：0.5kg(2)自由度数：4个自由度(3)座标型式：圆柱座标(4)手臂运动参数：伸缩行程100mm伸缩速度40mm/s升降行程50mm升降速度100mm/s回转范围0180回转速度90 /s(5)手腕运动参数:回转范围0180回转速度90 /s

22、(6)手指夹持范围：棒料：?5 ?20(7)手腕运动参数：回转范围0 180回转速度90 /s(8)手指夹持范围：棒料. 80mm 150mm(9)定位方式：行程开关(10)定位精度：1mm(11)驱动方式：气压传动(12)控制方式：点位程序控制(采用PLC)3手腕结构设计手腕的自由度手腕是连接手部和手臂的部件，它的作用是调整或改变工件的方位，因而它具有独 立的自由度，以使机械手适应复杂的动作要求。手腕自由度的选用与机械手的通用性、 加工工艺要求、工件放置方位和定位精度等许多因素有关。由于本机械手抓取的工件是 水平放置，同时考虑到通用性，因此给手腕设一绕x轴转动回转运动才可满足工作的要求目前实

23、现手腕回转运动的机构，应用最多的为回转油（气）缸。手腕的驱动力矩计算手腕转动时所需要的驱动力矩手腕的回转、上下和左右摆动均为回转运动，驱动手腕回转时的驱动力矩必须克服 手腕起动时所产生的惯性力矩，手腕的转动轴与支承孔处的摩擦阻力矩，动片与缸径、 定片、端盖等处密封装置的摩擦阻力矩以及由于转动件的中心与转动轴线不重合所产生 的偏重力矩.图3-1所示为手腕受力的示意图。1.工件2.手部3.手腕图4-1手碗回转时受力状态手腕转动时所需的驱动力矩可按下式计算:(3-1 )M驱 M惯 M偏 M摩 M封式中：M驱-驱动手腕转动的驱动力矩（N cm）M惯-惯性力矩（N cm）M偏参与转动的零部件的重量（包括

24、工件、手部、手腕回转缸的动片 ）对转动 轴线所产生的偏重力矩（N cm）下面以图4-1所示的手腕受力情况，分析各阻力矩的计算：（1）手腕加速运动时所产生的惯性力矩 M惯若手腕起动过程按等加速运动，手腕转动时的角速度为，起动过程所用的时间为t ,则：M 惯（J J1） （N .cm）式中：J-参与手腕转动的部件对转动轴线的转动惯量Ji-工件对手腕转动轴线的转动惯量 3cms ）若工件中心与转动轴线不重合，其转动惯量 Ji为：J J G1J1 Jc2g e式中：Jc-工件对过重心轴线的转动惯量（N.Cm$2）Gl-工件的重量（N）e1 -工件的重心到转动轴线的偏心距（cm）-手腕转动时的角速度（弧

25、度/s）t -起动过程所需的时间（s）一起动过程所转过的角度（弧度）（2）手腕转动件和工件的偏重对转动轴线所产生的偏重力矩M偏M偏 Gie)+ G3e3 ( N cm)(3-2)(3-3)(3-4)式中：G3-手腕转动件的重量（N）e3-手腕转动件的重心到转动轴线的偏心距（cm）当工件的重心与手腕转动轴线重合时，则 Ge 03.手腕转动轴在轴颈处的摩擦阻力矩 M封M 封 上（RAd2 RBdi）（N ?cm）（3-5）2式中：d1 , d2-转动轴的轴颈直径（cm）f -摩擦系数，对于滚动轴承f 0.01,对于滑动轴承f 0.1Ra, Rb-处的支承反力（N）,可按手腕转动轴的受力分析求解，根

26、据MbF 0,得:RbIG3I3G2I2GilGiliG2I2G313Rb同理，根据 MbF 0,得:RaGi(l li) G2。 I2) G3(l I3)l(3-6)(3-7)(3-8)式中：G2-的重量(N)lolilzk一如图4-i所示的长度尺寸(cm)4手臂伸缩、升降回转气缸的尺寸计算和校核手臂伸缩气缸的尺寸设计与校核手臂伸缩气缸的尺寸设计手臂伸缩气缸采用烟台气动元件厂生产的标准气缸，参看此公司生产的各种型号的结构特点，尺寸参数，结合本设计的实际要求，气缸用CTA型气缸，尺寸系列初选内径为100/63。尺寸校核.在校核尺寸时，只需校核气缸内径 D1 63mm半径R=31.5mm的气缸的

27、尺寸满足使用要求即可,设计使用压强P 0.4MPa ,则驱动力:(4-1)PR20.4 106 3.14 0.031521246(N)测定手腕质量为50kg,设计加速度a10ms,则惯性力:F1ma(4-2)50 10500(N)2.考虑活塞等的摩擦力，设定摩擦系数k 0.2,Fmk.F1总受力F0FiFm(4-4)(4-3)0.2 500100(N)500 100600(N)F0 F所以标准CTA气缸的尺寸符合实际使用驱动力要求。导向装置气压驱动的机械手臂在进行伸缩运动时，为了防止手臂绕轴线转动，以保证手指的 正确方向，并使活塞杆不受较大的弯曲力矩作用，以增加手臂的刚性，在设计手臂结构 时，

28、应该采用导向装置。具体的安装形式应该根据本设计的具体结构和抓取物体重量等 因素来确定，同时在结构设计和布局上应该尽量减少运动部件的重量和减少对回转中心 的惯量。导向杆目前常采用的装置有单导向杆，双导向杆，四导向杆等，在本设计中才 用单导向杆来增加手臂的刚性和导向性。平衡装置在本设计中，为了使手臂的两端能够尽量接近重力矩平衡状态，减少手抓一侧重力 矩对性能的影响，故在手臂伸缩气缸一侧加装平衡装置，装置内加放整码，整码块的质 量根据抓取物体的重量和气缸的运行参数视具体情况加以调节，务求使两端尽量接近平 衡。手臂升降缸的尺寸设计与校核尺寸设计.测定手腕质量为80kg,则重力：G mg(4-5)80

29、10800(N).设计加速度a 5%,则惯性力：G1 ma80 5 400(N)考虑活塞等的摩擦力，设定一摩擦系数 k 0.1 ,Gm kG10.1 40040(N)总受力Gq G G1 Gm(4-6)(4-7)(4-8)800 400 401240(N)Gq G0所以设计尺寸符合实际使用要求。手臂回转缸的尺寸设计与校核尺寸设计气缸长度设计为b 120mm，气缸内径为Di 210mm，半径R=l05mm,轴D2 40mm 半径R 20mm,气缸运行角速度=90/s,加速度时间t 0.5s印强P 0.4MPa_ 22(4-9)M pb(R r )20.4 106 0.12(0.1052 0020

30、2)2255(N.m)尺寸校核测定参与手臂转动的部件的质量m1120kg,分析部件的质量分布情况，质量密度等效分布在一个半径r 200mm的圆盘上，那么转动惯量：2mr(4-10)j2_2120 0。0220.6 (对小)(4-11 )0.6900.5108(N.m)考虑轴承，油封之间的摩擦力，设定一摩擦系数k 0.2总驱动力矩:M摩 k.M惯0.2 1085.4( N .m)M驱 M惯 M摩108 5.4113.4(N.m)(4-12)(4-13)M驱M设计尺寸满足使用要求5气动系统设计5.1气压传动系统工作原理图图6-1为该机械手的气压传动系统工作原理图。它的气源是由空气压缩机（排气压 力

31、大于0.4-0.6MPa）通过快换接头进入储气罐，经分水过滤器、调压阀、油雾器，进入 各并联气路上的电磁阀，以控制气缸和手部动作。闫豫#手稿牌通*手背屋将打手U曲气打图5-1机械手气压传动原理图表5-1气动元件1QF-44手动截止阀12储气缸23QSL-26-S1分水滤气器14QTY-20-S1减压阀15QIU-20-S1油雾器16YJ-1压力继电器17Q24DH-10-S1二位五通电磁滑阀18Q24D2H-10-S1二位五通电磁滑阀49Q24D2H-15-S1二位五通电磁滑阀110单向节流阀211LI-25单向节流阀2121各执行机构调速，凡是能采用排气口节流方式的，都在电磁阀的排气口安装节

32、流阻 尼螺钉进行调速，这种方法的特点是结构简单，效果尚好。如手臂伸缩气缸在接近气缸处安装两个快速排气阀，可以加快启动速度，也可调节全程上的速度。升降气缸采用进 气节流的单向节流阀以调节手臂上升速度。由于手臂可自重下降，其速度调节仍采用在 电磁阀排气口安装节流阻尼螺钉来完成。气液传送器气缸侧的排气节流，可用来调整回 转液压缓冲器的背压大小。为简化气路，减少电磁阀的数量，各工作气缸的缓冲均采用液压缓冲器。这样可以 省去电磁阀和切换调节阀或行程节流阀的气路阻尼元件。电磁阀的通径，是根据各工作气缸的尺寸、行程、速度计算出所需压缩空气流量， 与所选用电磁阀在压力状态下的公称使用流量相适应来确定的。6机械

33、手的PLC控制可编程序控制器的选择及工作过程可编程序控制器的选择目前，国际上生产可编程序控制器的厂家很多，如日本三菱公司的F系列PC,德国西门子公司的SIMATIC N5系列PC、日本OMRON（立石）公司的C型、P型PC等11。 考虑到本机械手的输入输出点不多，工作流程较简单，同时考虑到制造成本，因此在本 次设计中选择了 OMRON公司的C28P型可编程序控制器12。工作过程可编程序控制器是通过执行用户程序来完成各种不同控制任务的。为此采用了循环 扫描的工作方式，具体的工作过程可分为 4个阶段12 o第一阶段是初始化处理：可编程序控制器的输入端子不是直接与主机相连， CPU对输入输出状态的询

34、问是针 对输入输出状态暂存器而言的11。输入输出状态暂存器也称为I/O状态表.该表是一个 专门存放输入输出状态信息的存储区12 0开机时，CPU首先使I/O状态表清零，然后 进行自诊断。当确认其硬件工作正常后，进入下一阶段。第二阶段是处理输入信号阶段：在处理输入信号阶段，CPU对输入状态进行扫描，将获得的各个输入端子的状态信 息送到I/O状态表中存放8。在同一扫描周期内，各个输入点的状态在I/O状态表中一直保持不变，不会受到各个输入端子信号变化的影响 9,因此不能造成运算结果混乱， 保证了本周期内用户程序的正确执行。第三阶段是程序处理阶段：当输入状态信息全部进入I/O状态表后，CPU工作进入到

35、第三个阶段8。在这个阶 段中，可编程序控制器对用户程序进行依次扫描，并根据各 I/O状态和有关指令进行运 算和处理9,最后将结果写入I/O状态表的输出状态暂存器中。第四阶段是输出处理阶段：段CPU对用户程序已扫描处理完毕，并将运算结果写入到I/O状态表状态暂存器中10 0此时将输入信号从输出状态暂存器中取出，送到输出锁存电路，驱动输出继电器 线圈，控制被控设备进行各种相应的动作8。然后，CPU又返回执行下一个循环的扫描周期。6.2机械手可编程序控制器控制方案系统简介控制对象为圆柱座标气动机械手。它的手臂具有三个自由度，即水平方向的伸、 缩，竖直方向的上、下，绕竖直轴的顺时针方向旋转及逆时针方向

36、旋转。另外，其末端 执行装置一机械手，还可完成抓、放功能。以上各动作均采用气动方式驱动，即用五个 二位五通电磁阀（每个阀有两个线圈，对应两个相反动作 ）分别控制五个气缸，使机械手 完成伸、缩、上、下、旋转及机械手抓放动作。其中旋转运动用一组齿轮齿条，使气缸 的直线运动转化为旋转运动。这样，可用 PLC的8个输出端与电磁阀的8个线圈相连，通过编程，使电磁阀各线圈按一定序列激励，从而使机械手按预先安排的动作序列工作.如果欲改变机械手的动作，不需改变接线，只需将程序中动作代码及顺序稍加修改即 可。另外，除抓放外，其余六个动作末端均放置一限位开关，以检测动作是否到位，如 果某动作没有到位，则出错指示灯

37、亮。工业机械手的工作流程此机械手用于自动输送线的上下料。当按下机械手启动按钮之后，机械手有如下动 作：先右转至右限位开关动作（1DT通电） 下降至下限位开关（5DT通电）手腕逆时针转动90 （7DT通电）手臂伸长至限位开关（3DT通电）检查有无物品，若有物品，手爪抓紧（9DT通电）手臂收缩至限位开关（4DT通电） 上升至上限位开关（6DT通电）左转至左限位开关动作（2DT通电）手腕顺时针转动90 （8DT通电） 手臂伸长至最长（3DT通电）手爪松开（10DT通电） 延时手臂收缩最短（4DT通电）。至此，一个工作循环完毕。机械手工作时序图/O分配根据系统输入输出点的数目，选用 OMRON C28

38、P型PC,它有16个输入点，标号为0000-0015, 12个输出点，标号为0500-0511。表6-1 I/O分配输入启动0000手臂左转0500停止0001手臂右转0501手抓抓紧0002手臂伸长0502左转限位开关0003手臂收缩0503右转限位开关0004手臂上升0504伸长限位开关0005手臂下降0505收缩限位开关0006手臂逆转0506上升限位开关0007手臂顺转0507下降限位开关0008手臂抓紧0508逆转限位开关0009手臂放松0509顺转限位开关0010物品检测0011.梯形图设计根据机械手的逻辑时序图及I/O分配，画出控制梯形图，如附图所示。由梯形图可以看出：（1）手臂

39、左转的条件：左转不到位（0003为OFF）,收缩到位（0006为ON）,上升到位 （0007为ON）,手腕逆转到位（0009为ON）,手爪抓紧（0002为ON）,无右转命令（0501为 OFF）。（2）手臂右转的条件：右转不到位（0004为OFF）,上升到位（0007为ON）,收缩到位（0006为ON）,手腕顺转到位（0010为ON）,手爪放松（0002为OFF）,无左转命令（0500为 OFF）。（3）手臂伸长的条件：伸长不到位（0005为OFF）,无收缩命令（0503为OFF）,并且满 足下列条彳之一：1）右转到位（0004为ON）,下降到位（0008为ON）,手腕逆转到位 （0009为

40、ON）,手爪放松（0002为 OFF）; 2）左转到位（0003为 ON）,上升到位（0007为 ON）,手腕顺转到位（0010为ON）,手爪抓紧（0002为ON）。（4）手臂收缩的条件：收缩不到位（0006为OFF）,无伸长命令0502为OFF,并且满 足下列条彳之一：1）右转到位（0004为ON）,下降到位（0008为ON）,手腕逆转到位 （0009为ON）,手爪抓紧（0002为ON）; 2）左转到位（0003为ON）,上升到位（0007为 ON）,手爪抓紧（0002为ON）,手腕顺转到位（0010为ON）。（5）手臂上升的条件：上升不到位（0007为OFF）,无下降命令（0505为OFF

41、）,收缩到 位（0006为ON）,手腕逆转到位（0009为ON）,手爪抓紧（0002为ON）,右转到位（0004为 ON）.（6）手臂下降的条件：下降不到位（0008为OFF）,无上升命令（0504为OFF）,右转到 位（0004为ON）,收缩到位（0006为ON）,手腕顺转到位（0010为ON）,手爪放松（0002为 OFF）。（7）手腕逆转的条件：逆转不到位（0009为OFF）,无顺转命令（0507为OFF）,右转到 位（0004为ON）,收缩到位（0006为 ON）,下降到位（0008为 ON）,手爪放松（0002为 OFF）。（8）手腕顺转的条件：顺转不到位（0010为OFF）,无逆转

42、命令（0506为OFF）,左转到 位（0003为ON）,收缩到位（0006为ON）,上升到位（0007为ON）,手爪抓紧（0002为 ON）。（9）手爪抓紧的条件：手爪未抓到物品（0002为OFF）,无放松命令（0509为OFF）,并 且满足下列条件之一：1）右转到位（0004为ON）,伸长到位（0005为ON）,下降到位 （0008为ON）,手腕逆转到位（0009为ON）,检测到有物品（0011为ON）, 2）左转到位 （0003为ON）,伸长到位（0005为ON）,上升到位（0007为ON）,手腕顺转到位（0010为 ON）。（10）手爪放松的条件：手爪抓紧（0002为ON）,无抓紧命令（

43、0508为OFF）,并且满足 下列条件一：1）左转到位（0003为ON）,伸长到位（0005为ON）,上升到位（0007为ON）, 手腕顺转到位（0010为ON）。2）左转到位（0003为ON）,上升到位（0007为ON）,手腕顺转 到位（0010为ON）,收缩到位（0006为ON）。另外，当按下停止按钮时，手臂停止动作， 即手臂停止在不定的位置。.机械手控制程序控制程序如表6-2,6-3表6-2地址指令数据地址指令数据0000LD00000038AND0007OR1000AND0010AND NOT0001AND0002OUT1000AND NOT0006LD1000OR LDIL(02)A

44、ND NOT0502LD NOT0003OUT0503AND0006LD0006AND0007AND0009AND0009AND0002AND0002AND0004AND NOT0501AND NOT0007OUT0500AND NOT0505LD0004OUT0504AND0008LD0004AND0009AND0006AND NOT0002AND0010LD0003AND NOT0003AND0007AND NOT0009AND0010AND NOT0507AND0002OUT0506OR LDLD0003AND NOT0005AND0006AND NOT0503AND0007OUT0502AND NOT0002LD0004AND NOT0010AND0008AND