气动机械手回转臂结构设计.doc

毕 业 设 计
气动机械手回转臂结构设计

毕 业 设 计 任 务 书

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

其中：
参考文献篇数：
说明书字数：
图纸张数：
10篇以上
6 000字以上
折合A0图纸3张，其中至少1张装配图
专业负责人意见

签名：
年 月 日

气动机械手回转臂结构设计
摘要
本文简要介绍了工业机器人的概念，机械手的组成和分类，机械手的自由度和坐标形式，气动技术的特点，PLC控制的特点及国内外的发展状况。
本文对机械手进行总体方案设计，确定了机械手的坐标形式和自由度，确定了机械手的技术参数。同时，设计了机械手的夹持式手部结构，设计了机械手的手腕结构，计算出了手腕转动时所需的驱动力矩和回转气缸的驱动力矩。设计了机械手的手臂结构。
设计出了机械手的气动系统，绘制了机械手气压系统工作原理图，对气压系统工作原理图的参数化绘制进行了研究，大大提高了绘图效率和图纸质量。
利用可编程序控制器对机械手进行控制，选取了合适的PLC型号，根据机械手的工作流程制定了可编程序控制器的控制方案，设计了机械手的工作时序图，并绘制了可编程序控制器的控制程序。设计达到了设计的预期目标。

关键词　工业机器人；机械手；气动；PLC

Pneumatic manipulator arm structure design
Abstract
This 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 overall 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 cylinder 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 programmable 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　 Industrial robot; Manipulator ; Air pressure drive; PLC

目录
摘要
Abstract
1 绪论 1
1.1 气动机械手概述 1
1.2 机械手的组成和分类 1
1.2.1 机械手的组成 1
1.2.2 机械手的分类 1
1.3 国内外发展状况 2
1.4 课题的提出及任务 2
2 机械手的设计方案 4
2.1 机械手的坐标形式与自由度 4
2.2 机械手的手部结构方案设计 4
2.3 机械手的手腕方案设计 4
2.4 机械手驱动方案设计 4
2.5 机械手技术参数列表 4
3 手腕结构设计 6
3.1 手腕的自由度 6
3.2 手腕的驱动力矩计算 6
3.2.1 手腕转动时所需要的驱动力矩 6
4 手臂伸缩、升降回转气缸的尺寸计算和校核 9
4.1 手臂伸缩气缸的尺寸设计与校核 9
4.1.1 手臂伸缩气缸的尺寸设计 9
4.1.2 尺寸校核 9
4.1.3 导向装置 10
4.1.4 平衡装置 10
4.2 手臂升降缸的尺寸设计与校核 10
4.2.1 尺寸设计 10
4.3 手臂回转缸的尺寸设计与校核 11
4.3.1 尺寸设计 11
4.3.2 尺寸校核 11
5 气动系统设计 13
5.1 气压传动系统工作原理图 13
6 机械手的PLC控制 15
6.1 可编程序控制器的选择及工作过程 15
6.1.1 可编程序控制器的选择 15
6.1.2 工作过程 15
6.2 机械手可编程序控制器控制方案 16
6.2.1 系统简介 16
6.2.2 工业机械手的工作流程 16
6.2.3 机械手工作时序图 16
结论 21
参考文献 22

致谢 26

机械手的PLC控制
1 绪论
1.1 气动机械手概述
气动机械手由操作机(机械本体)、控制器、伺服驱动系统和检测传感装置构成，是一种仿人操作，自动控制、可重复编程、能在三维空间完成各种作业的机电一体化自动化设备[3]。它对稳定、提高产品质量，提高生产效率，改善劳动条件和产品的快速更新换代起着十分重要的作用[1]。机器人应用情况，是一个国家工业自动化水平的重要标志。在工业生产中应用的机械手被称为“工业机械手” [4]。生产中应用机械手可以提高生产的自动化水平和劳动生产率:可以减轻劳动强度、保证产品质量、实现安全生产[1]。由于通用机械手能很快的改变工作程序，适应性较强，所以它在不断变换生产品种的中小批量生产中获得广泛的引用。
1.2 机械手的组成和分类
1.2.1 机械手的组成
机械手主要由执行机构、驱动系统、控制系统以及位置检测装置等所组成[4]。各系统相互之间的关系如方框图1-1所示。

图1-1 机械手组成方框图
1.2.2 机械手的分类
一、按用途分
机械手可分为专用机械手和通用机械手两种[4]:
（1）专用机械手
它是附属于主机的、具有固定程序而无独立控制系统的机械装置[4]。专用机械手具有动作少、工作对象单一、结构简单、使用可靠和造价低等特点[1]，适用于大批量的自动化生产的自动换刀机械手，如自动机床、自动线的上下料机械手和加工中心[3]。
（2）通用机械手
它是一种具有独立控制系统的、程序可变的、动作灵活多样的机械手[3]。通用机械手的工作范围大、定位精度高、通用性强，适用于不断变换生产品种的中小批量自动化的生产[4]。
二.按驱动方式分
（1）液压传动机械手
液压传动机械手以液压的压力来驱动执行机构运动的机械手[3]。其主要特点是:抓重可达几百公斤以上、传动平稳、结构紧凑、动作灵敏[1]。但对密封装置要求严格，不然油的泄漏对机械手的工作性能有很大的影响，且不宜在高温、低温下工作[4]。
（2）气压传动机械手
气压传动机械手以压缩空气的压力来驱动执行机构运动的机械手[3]。其主要特点是:介质李源极为方便，输出力小，气动动作迅速，结构简单，成本低[1]。
（3）机械传动机械手
机械传动机械手是由机械传动机构(如凸轮、连杆、齿轮和齿条、间歇机构等)驱动的机械手[3]。它是一种附属于工作主机的专用机械手，其动力是由工作机械传递的[1]。
1.3 国内外发展状况
国外机器人领域发展近几年有如下几个趋势:
（1）工业机器人性能不断提高(高速度、高精度、高可靠性、便于操作和维修)，而单机价格不断下降，平均单机价格从91年的10.3万美元降至97年的65万美元[2]。
（2）机械结构向模块化、可重构化发展。例如关节模块中的伺服电机、减速机、检测系统三位一体化：由关节模块、连杆模块用重组方式构造机器人整机;国外已有模块化装配机器人产品问市。
（3）工业机器人控制系统向基于PC机的开放型控制器方向发展，便于标准化、网络化；器件集成度提高，控制柜日见小巧，且采用模块化结构；大大提高了系统的可靠性、易操作性和可维修性。
1.4 课题的提出及任务
进入21世纪，随着我国人口老龄化的提前到来，近来在东南沿海还出现在大量的缺工现象，迫切要求我们提高劳动生产率，降低工人的劳动强度，提高我国工业自动化水平势在必行，将机械手，应用于工业自动化生产线，把工业产品从一条生产线搬运到另外一条生产线，实现自动化生产，减轻产业工人大量的重复性劳动，同时又可以提高劳动生产率。
本课题将要完成的主要任务如下:
(1) 进行气动机械手的总体研究，并进行整体运动方式设计；
(2) 设计气动机械手气路设计，进行关键部件的设计计算；
(3) 设计气动机械伸缩、回转臂部分结构，进行关键部件的设计计算；
（4）PLC控制系统的设计及编程。

2 机械手的设计方案
2.1 机械手的坐标形式与自由度
按机械手手臂的不同运动形式及其组合情况，其座标型式可分为直角座标式、圆柱座标式、球座标式和关节式[3]。由于本机械手在上下料时手臂具有升降、收缩及回转运动，因此，采用圆柱座标型式。相应的机械手具有三个自由度，为了弥补升降运动行程较小的缺点，增加手臂摆动机构，从而增加一个手臂上下摆动的自由度。
2.2 机械手的手部结构方案设计
为了使机械手的通用性更强，把机械手的手部结构设计成可更换结构，当工件是棒料时，使用夹持式手部，当工件是板料时，使用气流负压式吸盘。
2.3 机械手的手腕方案设计
考虑到机械手的通用性，同时由于被抓取工件是水平放置，因此手腕必须设有回转运动才可满足工作的要求。因此，手腕设计成回转结构，实现手腕回转运动的机构为回转气缸。
2.4 机械手驱动方案设计
由于气压传动系统的动作迅速，反应灵敏，阻力损失和泄漏较小，成本低廉因此本机械手采用气压传动方式。
2.5 机械手技术参数列表
一.用途：
用于自动输送线的上下料。
二.设计技术参数:
（1）抓重： 0.5
（2）自由度数： 4个自由度
（3）座标型式：圆柱座标
（4）手臂运动参数：
伸缩行程100mm
伸缩速度40mm/s
升降行程50mm
升降速度100mm/s
回转范围
回转速度
（5）手腕运动参数：
回转范围
回转速度
（6）手指夹持范围：棒料: ø5~ ø20
（7）手腕运动参数：
回转范围
回转速度
（8）手指夹持范围：
棒料:
（9）定位方式：行程开关
（10）定位精度：
（11）驱动方式：气压传动
（12）控制方式：点位程序控制(采用PLC)

3 手腕结构设计
3.1 手腕的自由度
手腕是连接手部和手臂的部件，它的作用是调整或改变工件的方位，因而它具有独立的自由度，以使机械手适应复杂的动作要求。手腕自由度的选用与机械手的通用性、加工工艺要求、工件放置方位和定位精度等许多因素有关。由于本机械手抓取的工件是水平放置，同时考虑到通用性，因此给手腕设一绕x轴转动回转运动才可满足工作的要求目前实现手腕回转运动的机构，应用最多的为回转油(气)缸。
3.2 手腕的驱动力矩计算
3.2.1 手腕转动时所需要的驱动力矩
手腕的回转、上下和左右摆动均为回转运动，驱动手腕回转时的驱动力矩必须克服手腕起动时所产生的惯性力矩，手腕的转动轴与支承孔处的摩擦阻力矩，动片与缸径、定片、端盖等处密封装置的摩擦阻力矩以及由于转动件的中心与转动轴线不重合所产生的偏重力矩.图3-1所示为手腕受力的示意图。

1.工件 2.手部 3.手腕
图4-1手碗回转时受力状态
手腕转动时所需的驱动力矩可按下式计算：
（3-1）
式中: - 驱动手腕转动的驱动力矩()
- 惯性力矩()
参与转动的零部件的重量(包括工件、手部、手腕回转缸的动片)对转动轴线所产生的偏重力矩()
下面以图4-1所示的手腕受力情况，分析各阻力矩的计算：
（1）手腕加速运动时所产生的惯性力矩M惯
若手腕起动过程按等加速运动，手腕转动时的角速度为，起动过程所用的时间为，则：
（3-2）
式中:- 参与手腕转动的部件对转动轴线的转动惯量
- 工件对手腕转动轴线的转动惯量
若工件中心与转动轴线不重合，其转动惯量为：
（3-3）
式中： - 工件对过重心轴线的转动惯量
- 工件的重量(N)
- 工件的重心到转动轴线的偏心距(cm)
- 手腕转动时的角速度(弧度/s)
- 起动过程所需的时间(s)
— 起动过程所转过的角度(弧度)
（2）手腕转动件和工件的偏重对转动轴线所产生的偏重力矩M偏
+ () （3-4）
式中: - 手腕转动件的重量(N)
- 手腕转动件的重心到转动轴线的偏心距(cm)
当工件的重心与手腕转动轴线重合时，则
3.手腕转动轴在轴颈处的摩擦阻力矩
（3-5）
式中: ，- 转动轴的轴颈直径(cm)
- 摩擦系数，对于滚动轴承，对于滑动轴承
,- 处的支承反力(N)，可按手腕转动轴的受力分析求解，
根据,得：
（3-6）
（3-7）

同理，根据,得：
（3-8）

式中：- 的重量(N)
— 如图4-1所示的长度尺寸(cm)

4 手臂伸缩、升降回转气缸的尺寸计算和校核
4.1 手臂伸缩气缸的尺寸设计与校核
4.1.1 手臂伸缩气缸的尺寸设计
手臂伸缩气缸采用烟台气动元件厂生产的标准气缸，参看此公司生产的各种型号的结构特点，尺寸参数，结合本设计的实际要求，气缸用CTA型气缸，尺寸系列初选内径为100/63。
4.1.2 尺寸校核
1.在校核尺寸时，只需校核气缸内径半径R=31.5mm的气缸的尺寸满足使用要求即可,设计使用压强,
则驱动力：
（4-1）

测定手腕质量为50kg,设计加速度，则惯性力：
（4-2）

2.考虑活塞等的摩擦力，设定摩擦系数,
（4-3）

总受力 （4-4）

所以标准CTA气缸的尺寸符合实际使用驱动力要求。

4.1.3 导向装置
气压驱动的机械手臂在进行伸缩运动时，为了防止手臂绕轴线转动，以保证手指的正确方向，并使活塞杆不受较大的弯曲力矩作用，以增加手臂的刚性，在设计手臂结构时，应该采用导向装置。具体的安装形式应该根据本设计的具体结构和抓取物体重量等因素来确定，同时在结构设计和布局上应该尽量减少运动部件的重量和减少对回转中心的惯量。导向杆目前常采用的装置有单导向杆，双导向杆，四导向杆等，在本设计中才用单导向杆来增加手臂的刚性和导向性。
4.1.4 平衡装置
在本设计中，为了使手臂的两端能够尽量接近重力矩平衡状态，减少手抓一侧重力矩对性能的影响，故在手臂伸缩气缸一侧加装平衡装置，装置内加放砝码，砝码块的质量根据抓取物体的重量和气缸的运行参数视具体情况加以调节，务求使两端尽量接近平衡。
4.2 手臂升降缸的尺寸设计与校核
4.2.1 尺寸设计
（1）．测定手腕质量为80kg,则重力：
（4-5）

（2）．设计加速度，则惯性力：
（4-6）

考虑活塞等的摩擦力，设定一摩擦系数，
（4-7）

总受力 （4-8）

所以设计尺寸符合实际使用要求。
4.3 手臂回转缸的尺寸设计与校核
4.3.1 尺寸设计
气缸长度设计为,气缸内径为,半径R=105mm,轴 半径,气缸运行角速度=，加速度时间0.5s,压强
（4-9）

4.3.2 尺寸校核
测定参与手臂转动的部件的质量,分析部件的质量分布情况，质量密度等效分布在一个半径的圆盘上，那么转动惯量：
（4-10）

（）
（4-11）

考虑轴承，油封之间的摩擦力，设定一摩擦系数
（4-12）

总驱动力矩：
（4-13）

设计尺寸满足使用要求。
5 气动系统设计
5.1 气压传动系统工作原理图
图6-1为该机械手的气压传动系统工作原理图。它的气源是由空气压缩机（排气压力大于0.4-0.6MPa）通过快换接头进入储气罐，经分水过滤器、调压阀、油雾器，进入各并联气路上的电磁阀，以控制气缸和手部动作。

图5-1 机械手气压传动原理图
表5-1 气动元件
序 号
型 号 规 格
名 称
数 量

1
QF-44
手动截止阀
1

2

储气缸
2

3
QSL-26-S1
分水滤气器
1

4
QTY-20-S1
减压阀
1

5
QIU-20-S1
油雾器
1

6
YJ-1
压力继电器
1

7
Q24DH-10-S1
二位五通电磁滑阀
1

8
Q24D2H-10-S1
二位五通电磁滑阀
4

9
Q24D2H-15-S1
二位五通电磁滑阀
1

10

单向节流阀
2

11
LI-25
单向节流阀
2

12

快速排气阀
1

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

6 机械手的PLC控制
6.1 可编程序控制器的选择及工作过程
6.1.1 可编程序控制器的选择
目前，国际上生产可编程序控制器的厂家很多，如日本三菱公司的F系列PC,德国西门子公司的SIMATIC N5系列PC、日本OMRON(立石)公司的C型、P型PC等[11]。考虑到本机械手的输入输出点不多，工作流程较简单，同时考虑到制造成本，因此在本次设计中选择了OMRON公司的C28P型可编程序控制器[12]。
6.1.2 工作过程
可编程序控制器是通过执行用户程序来完成各种不同控制任务的。为此采用了循环扫描的工作方式，具体的工作过程可分为4个阶段[12]。
第一阶段是初始化处理：
可编程序控制器的输入端子不是直接与主机相连，CPU对输入输出状态的询问是针对输入输出状态暂存器而言的[11]。输入输出状态暂存器也称为I/O状态表.该表是一个专门存放输入输出状态信息的存储区[12]。开机时，CPU首先使I/O状态表清零，然后进行自诊断。当确认其硬件工作正常后，进入下一阶段。
第二阶段是处理输入信号阶段：
在处理输入信号阶段，CPU对输入状态进行扫描，将获得的各个输入端子的状态信息送到I/O状态表中存放[8]。在同一扫描周期内，各个输入点的状态在I/O状态表中一直保持不变，不会受到各个输入端子信号变化的影响[9]，因此不能造成运算结果混乱，保证了本周期内用户程序的正确执行。
第三阶段是程序处理阶段：
当输入状态信息全部进入I/O状态表后，CPU工作进入到第三个阶段[8]。在这个阶段中，可编程序控制器对用户程序进行依次扫描，并根据各I/O状态和有关指令进行运算和处理[9]，最后将结果写入I/O状态表的输出状态暂存器中。
第四阶段是输出处理阶段：
段CPU对用户程序已扫描处理完毕，并将运算结果写入到I/O状态表状态暂存器中[10]。此时将输入信号从输出状态暂存器中取出，送到输出锁存电路，驱动输出继电器线圈，控制被控设备进行各种相应的动作[8]。然后，CPU又返回执行下一个循环的扫描周期。
6.2 机械手可编程序控制器控制方案
6.2.1 系统简介
控制对象为圆柱座标气动机械手。它的手臂具有三个自由度，即水平方向的伸、缩，竖直方向的上、下，绕竖直轴的顺时针方向旋转及逆时针方向旋转。另外，其末端执行装置— 机械手，还可完成抓、放功能。以上各动作均采用气动方式驱动，即用五个二位五通电磁阀(每个阀有两个线圈，对应两个相反动作)分别控制五个气缸，使机械手完成伸、缩、上、下、旋转及机械手抓放动作。其中旋转运动用一组齿轮齿条，使气缸的直线运动转化为旋转运动。这样，可用PLC的8个输出端与电磁阀的8个线圈相连，通过编程，使电磁阀各线圈按一定序列激励，从而使机械手按预先安排的动作序列工作.如果欲改变机械手的动作，不需改变接线，只需将程序中动作代码及顺序稍加修改即可。另外，除抓放外，其余六个动作末端均放置一限位开关，以检测动作是否到位，如果某动作没有到位，则出错指示灯亮。
6.2.2 工业机械手的工作流程
此机械手用于自动输送线的上下料。当按下机械手启动按钮之后，机械手有如下动作：
先右转至右限位开关动作(1DT通电) 下降至下限位开关(5DT通电) 手腕逆时针转动90 (7DT通电) 手臂伸长至限位开关(3DT通电) 检查有无物品，若有物品，手爪抓紧(9DT通电) 手臂收缩至限位开关(4DT通电) 上升至上限位开关(6DT通电) 左转至左限位开关动作(2DT通电) 手腕顺时针转动 (8DT通电) 手臂伸长至最长(3DT通电) 手爪松开(10DT通电) 延时 手臂收缩最短(4DT通电)。至此，一个工作循环完毕。
6.2.3 机械手工作时序图
1.I/O分配
根据系统输入输出点的数目，选用OMRON C28P型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

2.梯形图设计
根据机械手的逻辑时序图及I/O分配，画出控制梯形图，如附图所示。由梯形图可以看出：
(1)手臂左转的条件：左转不到位(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为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)，收缩到位(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)，无逆转命令(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)，无抓紧命令(0508为OFF),并且满足下列条件一：1)左转到位(0003为ON)，伸长到位(0005为ON),上升到位(0007为ON)，手腕顺转到位(0010为ON)。 2)左转到位(0003为ON),上升到位(0007为ON)，手腕顺转到位(0010为ON)，收缩到位(0006为ON)。另外，当按下停止按钮时，手臂停止动作，即手臂停止在不定的位置。
3.机械手控制程序
控制程序如表6-2,6-3

表6-2
地址
指令
数据
地址
指令
数据
0000
LD
0000
0038
AND
0007

OR
1000

AND
0010

AND NOT
0001

AND
0002

OUT
1000

AND NOT
0006

LD
1000

OR LD

IL(02)

AND NOT
0502

LD NOT
0003

OUT
0503

AND
0006

LD
0006

AND
0007

AND
0009

AND
0009

AND
0002

AND
0002

AND
0004

AND NOT
0501

AND NOT
0007

OUT
0500

AND NOT
0505

LD
0004

OUT
0504

AND
0008

LD
0004

AND
0009

AND
0006

AND NOT
0002

AND
0010

LD
0003

AND NOT
0003

AND
0007

AND NOT
0009

AND
0010

AND NOT
0507

AND
0002

OUT
0506

OR LD

LD
0003

AND NOT
0005

AND
0006

AND NOT
0503

AND
0007

OUT
0502

AND NOT
0002

LD
0004

AND NOT
0010

AND
0008

AND NOT
0506

AND
0009

OUT
0507

AND
0002

LD
0004

AND NOT
0006

AND
0005

LD
0003

AND
0008

表6-3
地址
指令
数据
地址
指令
数据
0076
AND
0009

AND
0011

LD
0003

AND
0005

AND
0007

AND
0010

OR LD

AND NOT
0002

AND NOT
0509

OUT
0508

LD
0003

AND
0007

AND
0010

AND
0002

AND
0005

LD
1001

OR LD

AND NOT
TIM(01)

OUT
1001

LD
1001

TIM00

LD
0003

AND
0005

AND
0007

AND
0010

LD
0003

AND
0007

AND
0010

OR LD

AND
0002

AND NOT
0508