1、河北工业大学基于 PLC 的机械手臂的设计院 部: 专 业: 班 级: 姓 名: * 学 号: * 指导老师: 河北工业大学毕业论文摘 要机械手是一种能自动化定位控制并可重新编程序以变动的多功能机器，本文介绍的是机械手模型基于 PLC 的控制系统设计。首先，对可编程控制器进行相应的介绍，选择了 PLC 的型号。然后，通过对机械手的各功能实现形式和控制方式研究，给出各部分的实现方案并确定了控制系统的器材。最后，进行 PLC 控制系统的硬件结构和软件程序设计。关键字： 可编程控制器 PLC 机械手 步进电机河北工业大学毕业论文ABSTRACTRobots are a kind of automat
2、ic positioning control and can be programmed to change to the multi-function machine are introduced in this paper, the model of the manipulator based on PLC control system design.First, the programmable controller to introduce, make corresponding choice model of the PLC. Then, based on the function
3、of the manipulator realization and control methods are studied, and the scheme of realization of the control system and the equipment. Finally, the PLC control system, the hardware structure and software design.Key words: PLC programmable controller Manipulator Stepping motor河北工业大学毕业论文目 录摘 要 IABSTRA
4、CTII第 1 章 绪论 .11.1 课题背景 11.2 机械手的定义与分类 11.3 机械手应用及组成结构 21.4 机械手的发展趋势 31.5 总体设计要求 3第 2 章 PLC 的介绍与选择 .52.1 PLC 的特点 .52.2 PLC 的选型 .52.3 三菱 FX 系列的结构功能 .7第 3 章 各功能实现形式与控制方式 .93.1 本机械手模型的机能和特性 93.2 夹紧机构 93.3 躯干 93.4 旋转编码盘 10第 4 章 控制系统设计 .114.1 控制系统硬件设计 114.1.1 PLC 梯形图中的编程元件 114.1.2 PLC 的 I/O 分配 .114.1.3 机
5、械手控制系统的外部接线图 .124.2 控制系统软件设计 134.2.1 公用程序 .134.2.2 自动操作程序 .154.2.3 手动单步操作程序 204.2.4 回原位程序 .234.3 PLC 程序的上载和下载 .254.3.1 PLC 程序的上载 254.3.2 PLC 程序的下载 25第 5 章 设计小结 .27致 谢 .28参 考 文 献 .29河北工业大学毕业论文1第 1 章 绪论1.1 课题背景随着现代工业技术的发展，工业自动化技术越来越高，生产工况也有趋于恶劣的态势，这对一线工人的操作技能也提出了更高的要求，同时操作工人的工作安全也受到了相应的威胁。工人工作环境和工作内容也
6、要求理想化简单化，对于一些往复的工作由机械手远程控制或自动完成显得非常重要。这样可以避免一些人不能接触的物质对人体造成伤害，如冶金、化工、医药、航空航天等。在机械制造业中，机械手应用较多，发展较快。目前主要应用于机床、模锻压力机的上下料以及焊接、喷漆等作业，它可以按照事先制定的作业程序完成规定的操作，有些还具备有传感反馈能力，能应付外界的变化。如果机械手发生某些偏离时，会引起零部件甚至机械本身的损坏，但若有了传感反馈自动，机械手就可以根据反馈自行调整。应 用 机 械 手 ， 有 利 于 提 高 材 料 的 传 送 、 工 件 的 装 卸 、 刀 具 的 更 换 以 及 机 器 的 装 配 等
7、的自 动 化 程 度 ， 从 而 可 以 提 高 劳 动 生 产 率 ， 降 低 生 产 成 本 ， 加 快 实 现 工 业 生 产 机 械 化 和自 动 化 的 步 伐 。机械手技术涉及到力学、机械学、电气液压技术、自动控制技术、传感器技术和计算机技术等科学领域，是一门跨学科综合技术。近 些 年 ， 随 着 计 算 机 技 术 、 电 子 技 术 以及 传 感 技 术 等 在 机 械 手 中 越 来 越 多 的 应 用 ， 机 械 手 已 经 成 为 工 业 生 产 中 提 高 劳 动 生 产率 的 重 要 因 素 。借助 PLC 强大的工业处理能力，很容易实现工业生产的自动化。基于此思路设
8、计的机械手，在实现各种要求的工序前提下，大大提高了工业过程的质量，而且大大解放了生产力，改善了工作环境，减轻了劳动强度，节约了成本，提高了生产效率，具有十分重要的意义。同时，借助组态软件的辅助作用，大大提高了系统的工作效率。因 此 ， 在 自 动 化 机床 和 综 合 加 工 自 动 生 产 线 上 ， 目 前 几 乎 都 设 有 机 械 手 ， 以 减 少 人 力 和 更 准 确 地 控 制 生产 的 节 拍 ， 便 于 有 节 奏 地 进 行 生 产 。工业机械手是近几十年发展起来的一种高科技自动化生产设备。工业机械手是工业机器人的一个重要分支。它的特点是可通过编程来完成各种预期的作业任务
9、，在构造和性能上兼有人和机器各自的优点，尤其体现了人的智能和适应性。机械手作业的准确性和各种环境中完成作业的能力，在国民经济各领域有着广阔的发展前景。综 上 所 述 ， 有 效 地 应 用 机 械 手 是 发 展 机 械 工 业 的 必 然 趋 势 。1.2 机械手的定义与分类机械手是一种能自动化定位控制并可重新编程序以变动的多功能机器，它有多个自由度，可用来搬运物体以完成在各个不同环境中工作。河北工业大学毕业论文2机械手的迅速发展是由于它的积极作用正日益为人们所认识。其一，它能部分代替人工操作；其二，它能按照生产工艺要求，遵循一定的程序、时间和位置来完成工件的传送和装卸；其三，它能操作必要的
10、机具进行焊接和装配。因此，它能大大地改善工人的劳动条件，显著地提高劳动生产率，加快实现工业生产机械化和自动化的步伐。因而，受到各先进工业国家的重视，并投入了大量的物力和财力加以研究和应用。尤其在高温、高压、粉尘、噪音以及带有放射性和污染的场合，应用得更为广泛。机械手一般分为三类。第一类是不需要人工操作的通用机械手，它是一种独立的不附属于某一主机的装置。它可以根据任务的需要编制程序，以完成各项规定工作。它的特点是除具备普通机械的物理性能外，还具备通用机械、记忆智能的三元机械。第二类是需要人工操作的，称为操作机。它起源于原子、军事工业，先是通过操作机来完成特定的作业，后来发展到用无线电信号操作机械
11、手来进行探测月球、火星等。第三类是专用机械手，主要附属于自动机床或自动线上，用于解决机床上下料和工件传送。这种机械手在国外称为“Mechanical Hand”，它是为主机服务的，由主机驱动，除少数外，工作程序一般是固定的，因此是专用的。本项目要求设计的机械手模型可归为第一类，即通用机械手。1.3 机械手应用及组成结构目前工业机械手主要用于流水线传送、焊接、装配、机床加工、铸造、热处理等方面，无论数量、品种和性能方面都能满足工业生产发展的需要。在国内主要是发展各方面的机械手，逐步扩大应用范围，以减轻劳动强度，改善作业条件。在应用专用机械手的同时，相应地发展通用机械手，专用条件还要研制示教机械手
12、、组合机械手等。将机械手各运动构件，如伸缩、摆动、升降、横移、俯仰等机构，以及用于不同类型的夹紧机构，设计成典型的通用机构，以便根据不同的作业要求，选用不同的典型部件，即可组成不同用途的机械手，即便于设计制造，又便于改换工作，扩大了应用的范围。同时要提高速度，减少冲击，正确定位，以更好地发挥机械手的作用。机械手主要由执行机构、驱动机构和控制系统构成。执行机构包括手部、手臂和躯干。手部装在手臂前端，可以转动、开闭手指。机械手手部的构造系统模仿人的手指，分为无关节、固定关节和自由关节三种。手指的数量又可以分为二指、三指、四指等，其中以二指用得最多。可根据夾持对象的形状和大小配备多种形状和尺寸的夹头
13、，以适应操作的需要。本设计采用二指的构造。手臂的作用是引导手指准确地抓住工件，并运送到所需要的位置上。为了使机械手能够正确地工作，手臂的三个自由度都需要精确地定位。总之，机械手的运动离不开直线移动和转动二种，因此它采用的执行机构主要是直线液压缸、摆动液压缸、电液脉冲马达、伺服液压马达、交流伺服电动机、直流伺服电动机和步进电动机等。躯干是安装手臂、动力源和各种执河北工业大学毕业论文3行机构的机架。驱动机构主要有四种：液压驱动、气压驱动、电气驱动和机械驱动。其中以电气、气动用得最多，占 90以上，液压、机械驱动用得较少。液压驱动主要是通过液压缸、阀、油箱等实现传动。气压驱动所采用的元件为气压缸、气
14、马达、气阀等。一般采用46 个大气压，个别达到 810 个大气压。本设计的手爪部分采用气压驱动。电气驱动时，直线运动可以采用电动机带动丝杠、螺母机构。通用机械手则考虑采用步进电动机、直流或交流的伺服电动机、变速箱等。本设计采用步进电动机驱动手臂运动，直流电动机驱动手爪和机械手的底盘旋转运动。机械驱动只适用于动作固定的场合。机械手控制的要素包括工作顺序、到达位置、动作时间、运动速度和加减速度等。机械手的控制分为点位控制和连续轨迹控制两种，目前以点位控制为主，占 90以上。控制系统可以根据动作的要求，设计采用数字顺序控制，它首先要编制程序加以储存，然后再根据规定的程序，控制机械手工作。对动作复杂的
15、机械手则采用数字控制系统、小型计算机或微处理机控制的系统。本设计的控制系统采用小型可编程控制器实现，具有编程简单、修改容易、可靠性高等。1.4 机械手的发展趋势机械手自二十世纪六十年代初问世以来，经过 40 多年的发展，现在已经成为制造业生产自动化中重要的机电设备。目前，机械手技术有了新的发展：出现了仿人型机械手、微型机械手和微操作系统（如细小工业管道机械手移动探测系统、微型飞行器等） 、机械手化机器、智能机械手（不仅可以进行事先设定的动作，还可按照工作状况相应地进行动作，如回避障碍物的移动，作业顺序的规划，有效的动态学习等） 。机械手的应用领域正在向非制造业和服务业方向扩展，并且蓬勃发展的军
16、用机械手也将越来越多地装备部队。国外方面：近几年国外工业机械手领域有如下几个发展趋势。机械手性能不断提高，而单机价格不断下降；机械结构向模块化、可重构化发展；控制系统向基于 PC 机的开放型控制器方向发展；传感器作用日益重要；虚拟现实技术在机械手中的作用已从仿真、预演发展到用于过程控制。国内方面：目前在一些机种方面，如喷涂机械手、弧焊机械手、点焊机械手、搬运机械手、装配机械手、特种机械手（水下、爬壁、管道、遥控等机械手）基本掌握了机械手操作机的设计制造技术，解决了控制驱动系统的设计和配置，软件的设计和编制等关键技术，还掌握了自动化喷漆线、弧焊自动线及其周边配套设备的全套自动通信、协调控制技术；
17、在基础元件方面，谐波减速器、机械手焊接电源、焊缝自动跟踪装置也有了突破。从技术方面来说，我国已经具备了独立自主发展中国机械手技术的基础。河北工业大学毕业论文41.5 总体设计要求1.机械手结构示意图图 1-1 机械手示意图1、手爪张开闭合 2、手腕旋转 3 、水平移动 4、升降 5 、立柱旋转 6、手爪 7 、手腕电动机 8、横轴 9、 竖轴 10、竖轴电动机 11、横轴电动机 12、底盘 13、底盘电动机2. 机械手工作流程机械手工作流程是：开始运行后，如果机械手不在初始位置上，步进电动机开始运转(横轴向手抓方向移动，竖轴向上移动)。归位后首先横轴步进电动机工作，横轴前伸；前伸到位后，手爪电
18、动机得电带动手爪旋转；当传感器检测到限位磁头时，电动机停止，PLC 控制电磁阀动作，手张开；延时一段时间，竖轴步进电动机工作，竖轴下降；下降到位后，电磁阀复位，手爪夹紧；延时过后，竖轴上升，同时横轴缩回、底盘电动机带动底盘旋转；当横轴、竖轴、底盘都到位后，横轴前伸；到位后手爪旋转，然后竖轴下降，电磁阀动作，手爪张开；延时后竖轴上升复位，然后开始下一周期动。3.控制要求(1)手臂上下直线运动。(2)手臂左右直线运动。(3) 手腕旋转运动。(4) 手爪夹紧动作。(5)机械手整体旋转运动。手臂采用步进电机驱动，由 PLC 发出控制脉冲控制步进电动机运转,实现手臂的进给和定位，手爪采用气压驱动。河北工
19、业大学毕业论文5第 2 章 PLC 的介绍与选择对于机械手的控制系统可以采用多种方式，如继电器控制、单片机控制、PLC 控制等。但由于 PLC 可编程控制器操作灵活性强和稳定性较好，所以，我们选择 PLC 控制。2.1 PLC 的 特点可编程控制器是在计算机技术、通信技术和继电器控制技术的发展基础上开发起来的，现已广泛应用于工业控制的各个领域。它以微处理器为核心，用编写的程序进行逻辑控制、定时、计数和算术运算等，并通过数字量和模拟量的输入/输出来控制机械设备或生产过程。高可靠性（1）所有的 I/O 接口电路均采用光电隔离，使工业现场的外电路与 PLC内部电路之间电气上隔离；（2）各输入端均采用
20、 R-C 滤波器，其滤波时间常数一般为1020ms ；（ 3）各模块均采用屏蔽措施，以防止辐射干扰；（4）采用性能优良的开关电源。 （5）对采用的器件进行严格的筛选；（6）良好的自诊断功能，一旦电源或其他软，硬件发生异常情况，CPU 立即采用有效措施，以防止故障扩大；（7）大型 PLC 还可以采用由双 CPU 构成冗余系统或有三 CPU 构成表决系统,使可靠性更进一步提高。丰富的 I/O 接口模块 PLC 针对不同的工业现场信号，如：交流或直流、开关量或模拟量、电压或电流、脉冲或电位、强电或弱电等。有相应的 I/O 模块与工业现场的器件或设备，如：按钮、行程开关、接近开关、传感器及变送器、电磁
21、线圈、控制阀等直接连接。采用模块化结构 为了适应各种工业控制需要，除了单元式的小型 PLC 以外，绝大多数 PLC 均采用模块化结构。PLC 的各个部件，包括 CPU、电源、I/O 等均采用模块化设计，由机架及电缆将各模块连接起来，系统的规模和功能可根据用户的需要自行组合。编程简单易学 PLC 的编程大多采用类似于继电器控制线路的梯形图形式，对使用者来说，不需要具备计算机的专门知识，因此很容易被一般工程技术人员所理解和掌握。安装简单，维修方便 PLC 不需要专门的机房，可以在各种工业环境下直接运行。使用时只需将现场的各种设备与 PLC 相应的 I/O 端相连接，即可投入运行。各种模块上均有运行
22、和故障指示装置，便于用户了解运行情况和查找故障。总之，可编程控制器是一台计算机，它是专为工业环境应用而设计制造的计算机。它具有丰富的输入/输出接口，并且具有较强的驱动能力。但可编程控制器产品并不针对某一具体工业应用，在实际应用时，其硬件需根据实际需要进行选用配置，其软件需根河北工业大学毕业论文6据控制要求进行设计编制。 2.2 PLC 的选型对于 PLC 的选择，我们必须考虑多方面的因素。例如输入、输出的最多点数，扫描速度，内存容量，指令条数，功能模块等。同时还要考虑其经济实用性以及工作环境对其的影响。1. 常用 PLC 介绍PLC 发展这么多年，技术成熟，各种型号的也很多，各个厂家生产的也有
23、一定区别，各个重点发展方向也不同，所以我们必须根据自己设计需要，考虑如何选择。西门子的中国业务是其亚太地区业务的主要支柱，活跃在中国的信息与通讯、自动化与控制、电力、交通、医疗、照明以及家用电器等各个行业中，其核心业务领域是基础设施建设和工业解决方案。欧姆龙 S7-200 系列 PLC 突出的特点：可靠性高、操作简便；丰富的内置集成功能；强劲通讯能力；丰富的扩展模块；简单、易用的 Micro/WIN 编程软件。OMRON 的可编程序控制器更加小型化。SYSMAC CPM1A 的大小仅相当于一个 PC卡(对于 10 点的机型来说)，从而使安装体积大幅度减小，同时也进一步节省了控制柜的空间。它不仅
24、具备了以往小型 PLC 所具备的功能，而且还可连接可编程序终端，为生产现场创造了新的环境。编程环境与 CQM1 及 SYSMAC A 等机种相同。由于原有SYSMAC 支持软件及编程器都可继续使用，故而系统的扩展及维护都可简单进行。三菱 FX 系列可编程控制器是当今国内外最新，最具特色、最具代表性的微型PLC。在 FX 中，除基本的指令表编程方式外，还可以采用梯形土编程及对应机械动作流程进行顺序设计的 SFC 顺序功能图编程，而且这些程序可互相转换。在 FX 系列 PLC中设置了高数计数器，对来自特定的输入继电器的高频脉冲进行中断处理，扩大了 PLC的应用领域。其 FX2N PLC 还可以采用
25、作为扩展设备的硬件计数器，可获取最高 50kHz的高速脉冲。2. 确定型号 FX1N60MR综上，对于被控对象，采用 PLC 系统与采用其它形式的控制系统相比较，力求具有较好的性价比，使用和维修方便；选用的 PLC 主机和配置、控制功能等必须能满足被控对象的各种控制要求；选用的 PLC 主机及配置必须是功能较强的新一代 PLC 机型，一般最好不要选用旧机型（若采用三菱公司的 PLC，则选 FX 系列，不选 F1 系列） 。同时还应当考虑将来工艺的变化和扩展，在满足确定的要求外，留有一定的余量；确保整个控制系统可靠。还要考虑大家对产品的熟悉程度，以及编程指令的易懂性。在此，我选用三菱 FX1N
26、来做控制核心。FX 系列 PLC 是由三菱公司近年来推出的高性能小型可编程控制器，以逐步替代三菱公司原 F、F1 、F2 系列 PLC 产品。其中 FX2 是近年推出的产品，FX0 是在 FX2 之后推出的超小型 PLC，近几年来又连续推出了将众多功能凝集在河北工业大学毕业论文7超小型机壳内的 FX0S、FX1S、FX0N、FX1N、FX2N、FX2NC 等系列 PLC，具有较高的性能价格比，应用广泛。它们采用整体式和模块式相结合的叠装式结构。2.2.3 FX1N 所具有优越性能CPU 处理速度达到了 0.065us/基本指令。内置了高达 64K 步的大容量 RAM 存储器。大幅增加了内部软元
27、件的数量。强化了指令的功能，提供了多达 209 条应用指令，包括像与三菱变频器通讯的指令，CRC 计算指令，产生随机数指令等等。晶体管输出型的基本单元内置了 3 轴独立最高 100kHz 的定位功能，并且增加了新的定位指令：带 DOG 搜索的原点回归（DSZR） ，中断单速定位（DVIT）和表格设定定位（TBL ） ，从而使得定位控制功能更加强大，使用更为方便。内置 6 点同时 100kHz 的高速计数功能，双相计数时可以进行 4 倍频计数。增强了通信的功能，其内置的编程口可以达到 115.2kbps 的高速通信，而且最多可以同时使用 3 个通信口（包括编程口在内） 。新增了高速输入输出适配器
28、，模拟量输入输出适配器和温度输入适配器，这些适配器不占用系统点数，使用方便，在 FX3U 的左侧最多可以连接 10 台特殊适配器其中通过使用高速输入适配器可以实现最多 8 路、最高200kHz 的高速计数。通过 CC-Link 网络的扩展可以实现最多达 384 点（包括远程 I/O 在内）的控制。可以选装高性能的显示模块（FX3U-7DM）可以显示用户自定义的英文、数字和日文汉字信息，最多能够显示：半角 16 个字符(全角 8 个字符) 4 行。在该模块上可以进行软元件的监控、测试，时钟的设定，存储器卡盒与内置 RAM 间程序的传送、比较等操作。另外，还可以将该显示模块安装在控制柜的面板上。2
29、.3 三菱 FX 系列的结构功能可编程控制器是一种工业控制微型计算机，它的结构原理与微型计算机相似。硬件构成有微处理器、存储器和各种输入、输出接口。系统程序和接口器件又与微机不同，这使它的操作使用方法、编程语言、工作方式等与微型机有所不同。PLC 是用微处理器实现继电器、定时器和计数器以及 A/D、D/A 模拟转换器件的组合体的功能，采用软件编程进行它们之间的联系。本设计采用 FX 系列 PLC 作为控制核心，所以现在就以它来讲述 PLC 的应用知识、操作技能。FX 系列 PLC 硬件组成与其它类型 PLC 基本相同，主体由三部分组成，其PLC 的基本结构如图 2-1 系统电源有些在 CPU
30、模块内，也有单独作为一个单元的，编程器一般看作 PLC 的外设。 PLC 内部采用总线结构，进行数据和指令的传输。河北工业大学毕业论文8图 2-1 PLC 的组成框图外部开关信号、模拟信号以及各种传感器检测信号作为 PLC 的输入变量，它们经PLC 的输入端子进入 PLC 的输入存储器，收集和暂存被控对象实际运行的状态信号和数据；经 PLC 内部运算与处理后，按被控对象实际动作要求产生输出结果；输出结果送到输出端子作为输出变量，驱动执行机构。PLC 的各个部分协调一致地实现对现场设备的控制。PLC 输入输出接口的安全保护当输出口连接电感类设备时，为了防止电路关断时刻产生高压对输入、输出口造成破
31、坏，应在感性元件两端加保护元件。对于直流电源，应并接续流二极管，对于交流电路应并接阻容电路。阻容电路中电阻可取 51120，电容取 0.10.47F，电容的额定电压应大于电源的峰值电压。续流二极管可选 1A 的管子，其额定电压应大于电源电压的 3 倍。图 2-2 为输入输出口的保护环节示意图。河北工业大学毕业论文9图 2-2 输入输出口的保护第 3 章 各功能实现形式与控制方式3.1 本机械手模型的机能和特性物体在三维空间内的禁止位置是由三个坐标和围绕三轴旋转的角度来决定的，因此，抓握物体的位置和方向能从理论上求得。根据资料的介绍，如果采用机械手，其机能要接近于人的上肢，则需要具有 27 个自
32、由度，而每一个自由度至少要有一根“人造肌肉”来控制。我们不要那么多自由度，因为根据实际情况而言，控制的自由度越多，其各个部分也就越复杂，相应的制造成本也就增加。本设计的机械手，它共有自由度 5 个。即：手臂前后伸缩、手臂上下伸缩、手臂左右旋转、手腕回转、手指的抓握。3.2 夹紧机构机械手手爪是用来抓取工件的部件。手爪抓取工件时要满足迅速、灵活、准确可靠的要求。设计制造夹紧机构机械手，首先要从机械手的坐标形式，运行速度和加速度的情况来考虑。其夹紧力的大小则根据夹持物体的重量、惯性和冲击力来计算。则同时考虑有足够的开口尺寸，以适应被抓物体的尺寸变化为扩大机械手的应用范围，还需备有多种抓取机构，以根
33、据需要来更换手爪。为防止损坏被夹的物体，夹紧力要限制在一定的范围内并镶有软质垫片、弹性衬垫或自动定心结构。为防止突然断电造成被抓物体落下，还可以有自锁结构。夹紧机构本身则结构简单、体积小、重量轻、动作灵活、和工作可靠。夹紧结构形式多样、有机械式、吸盘式和电磁式等。有的夹紧机构还带有传感装置和携带工具进行操作的装置。本设计采用机械式夹紧装置。机械式夹紧是最基本的一种，应用广泛，种类繁多。如按手指运动的方式和模仿人手的动作，可分为回转型、直进型；按夹持方式可分为内撑式、外撑式和自锁式；按手指数目可分为二指式、三指式、四指式；按动力来源可分为弹簧式、气动式、液压式等。本设计采用二指式手爪。由可编程控
34、制器控制电磁阀动作，从而控制手爪的开闭。手爪河北工业大学毕业论文10的回转则用一个直流电动机完成，同时通过两个限位开关完成回转角度的限位，一般可设置在 180 度。3.3 躯干躯干有底盘和手臂两部分组成。底盘是支撑机械手的全部重量并能带动手臂旋转的机构。底盘采用一个直流电动机驱动，底盘旋转时带动一个旋转编码盘旋转，机械手每旋转三度发出一个脉冲，由传感器检测并送入可编程控制器，从而计算底盘旋转的角度。同时，在底盘上装有限位开关，最大旋转角度可达 180 度。手臂是机械手的主要部分，它是支撑手爪、工件使它们运动的机构。本设计手臂由横轴和竖轴组成、可完成伸缩、升降的运动。手臂采用电动机带动丝杠、螺母
35、来实现伸缩和升降运动。由可编程控制器发出信号控制步进电机运转，同时在两轴的两端分别加限位开关限位。采用丝杠、螺母结构传动的特点是易于自锁、位置精度较高，传动效率较高。3.4 旋转编码盘机械手底盘和躯干每旋转 3 度发出一个脉冲，并把信号送回可编程控制器来得到转过的准确的角度。编码盘的机构如图 3-1。图 3-1 旋转编码盘可以通过改变程序中计数器 C0 的初值来确定所要转过的角度，这里可以通过用计算机读出指令表，然后修改得到不同的控制角度。综上所述，根据机械手的各部分要求条件可确定本设计机械手控制系统所选器材列表如表 3-1。表 3-1 所选器材列表名称 型号或规格 数量 名称 型号或规格 数
36、量河北工业大学毕业论文11PLC FX1N-60MR 1 限位开关 LX19-111 8电磁阀 VF3130 1 转换开关 LW6-5 1按钮 LA10-1H 13 熔断器 RC1A-30/15 2连接导线 若干第 4 章 控制系统设计4.1 控制系统硬件设计机械手电气控制系统，除了有多工步特点之外，还要求有连续控制和手动控制等操作方式。工作方式的选择可以很方便地在操作面板上表示出来，在手动方式时可以通过手动按钮来实现，其控制面板如下图 4-1。当旋钮打向回原点时，系统自动地回到右上角位置待命。当旋钮打向连续时，系统自动完成各工步操作，且循环动作。当旋钮打向手动时，每一工步都要按下该工步按钮才
37、能实现。图 4-1 控制面板示意图4.1.1 PLC 梯形图中的编程元件设计选用 FX1N60MR ，其输入继电器（X）36 点，输出继电器(Y)24 点，辅助继电器(M)384 点，状态继电器(S)1000 点，定时器(T)256 点，计数器(C)，数据寄存器(D)等。河北工业大学毕业论文12特殊辅助继电器M8000运行监控（PLC 运行时自动接通，停止时断开） ；M8002初始脉冲（仅在 PLC 运行开始时接通一个扫描周期） ；M8005PLC 后备锂电池电压过低时接通；M801110ms 时钟脉冲； M8013100ms 时钟脉冲；M80121s 时钟脉冲； M80141min 时钟脉冲
38、。4.1.2 PLC 的 I/O 分配根据机械手动作的要求，输入、输出分配如表 4-1 所示。表 4-1 PLC 输入/输出分配表输入信号 输出信号手动 SA YA0 Y0回原位 SA X1 YA1 Y1连续 SA X2上升/下降步进电机YA2 Y2回原位 SB1 X3 YA3 Y3启动 SB2 X4 YA4 Y4停止 SB3 X5前进/后退步进电机YA5 Y5下降 SB4 X6 夹紧 YA6 Y6上升 SB5 X7 手顺转 YA 7 Y7夹紧 SB6 X10 手逆转 YA 8 Y10松开 SB7 X11 底盘顺转 YA 9 Y11手顺转 SB8 X12 底盘逆转 YA10 Y12手逆转 SB
39、9 X13底盘顺转 SB10 X14底盘逆转 SB11 X15下限位 SQ1 X16上限位 SQ2 X17前限位 SQ3 X20后限位 SQ4 X21底盘顺限位 SQ5 X22底盘逆限位 SQ6 X23手顺限位 SQ7 X24手逆限位 SQ8 X25底旋转脉冲 X26河北工业大学毕业论文13前行 SB12 X30后退 SB13 X314.1.3 机械手控制系统的外部接线图PLC 外部电气接线图如下图 4-2PLC 外部电气接线图 4-24.2 控制系统软件设计机械手控制系统软件设计的程序总体结构如图 4-3，分为公用程序、自动程序、手动程序和回原位程序等四部分。其中自动程序包括单步、连续运动程
40、序，因它们的工作顺序相同所以可将它们和编在一起。CJ（FNC00）是条件跳转应用指令，指针标号 PX是其操作数。该指令由于某种条件下跳过 CJ 指令和指针标号之间的程序，从指针标号处继续执行，以减少程序执行时间。如果选择“手动”工作方式，即 X0 为 ON，X1 为OFF 则 PLC 执行完公用程序后将跳过自动程序到 P0 处，由于 X0 动断触点断开所以直接执行“手动程序” 。由于 P1 处的 X1 的动断触点闭合，所以又跳过回原位程序到 P2 处。如果选择“回原位”工作方式，同样只执行公用程序和回原位程序，如果选择“连续”方式，则只执行公用程序和自动程序。河北工业大学毕业论文144.2.1
41、 公用程序公用程序如图 4-4，简要说明如下：当 Y6 复位（电磁阀松开） 、后限位 X21 和上限位 X17 接通时，辅助继电器 M0 变为 ON，表示机械手在原位。如果开始执行用户程序（M8002 为 ON） 、系统处于手动或回原位状态（ X0 或 X1 为 ON） ，那么初始步对应的M10 被置位，连续工作方式做好准备。如果 M0 为 OFF，M10 被复位，系统不能进入连续工作方式。指令 ZRST 是成批复位应用指令，以防止系统从自动方式转换手动方式，再返回自动方式时出现两种不同的活动步。图 4-3 程序总的结构图河北工业大学毕业论文15图 4-4 公用程序梯形图4.2.2 自动操作程
42、序自动操作顺序功能流程图见图4-5 所示。当机械手处于原位时，按启动 X4 接通，状态转移到 S1，驱动前伸 Y3，当到达前限位使行程开关 X20 接通，状态转移到 S2，而S1 自动复位。驱动手顺转 Y7，X24接通，状态转移到 S3，驱动下降Y2，X16 接通，状态转移到 S4，S4驱动 Y6 置位，延时 1 秒，以使电磁力达到最大夹紧力。当 T0 接通，状态转移到 S5，驱动 Y0 上升，当上升到达最高位，X17 接通，状态转移到 S6。S6 驱动 Y4 后退。移到后限位，状态转移到 S7 底逆转 Y12，状态到 S8，X20 接通，状态转移到 S9 下降。下降到最低位，X16 接通，电
43、磁铁放松。为了使电图 4-5 自动的功能流程图/底 顺 转后 退手 逆 转上 升松 开下 降/前 伸底 逆 转后 退上 升夹 紧下 降手 顺 转前 伸初 始 回 原 点河北工业大学毕业论文16磁力完全失掉，延时 1 秒。延时时间到，T1 接通，状态转移到 S11 上升。上升到最高位，X25 接通，状态转移到 S13 后退。后退到后限位，使 X21 接通，状态转移到 S14，底盘顺转是 X21 接通，返回初始状态，再开始第二次循环动作。在编写状态转移图时注意各状态元件只能使用一次，但它驱动的线圈，却可以使用多次，但两者不能出现在连续位置上。因此步进顺控的编程，比起用基本指令编程较为容易，可读性较
44、强。自动连续程序说明：当系统处于自动连续方式时，X2 为 ON，它的动合触点闭合，在初始步时按下启动按钮 X4，M1 得电并保持，就按照图 4-5 自动功能图进行工作。按下停止按钮 X7 后，M1 变为 OFF，系统不会立即停止，而是完成当前的工作周期后，机械手最终停止在原位。根据自动功能流程图的顺序编写的自动程序梯形图为图 4-6。河北工业大学毕业论文18河北工业大学毕业论文19河北工业大学毕业论文20河北工业大学毕业论文21河北工业大学毕业论文22图 4-6 自动程序段梯形图4.2.3 手动单步操作程序 如下图所示。图中上升/下降，左移/右移都有连锁和限位保护。手动程序说明：用对应机械手的上下前后移动和夹紧松开按钮。按下不同的按钮，机械手执行相应的动作。在前后移动的程序中串联上线位置开关的动合触点是为了避免机械手在较低位置移动时碰撞其他工件。为保证系统安全运行，程序之间还进行必要的连锁。河北工业大学毕业论文23河北工业大学毕业论文24河北工业大学毕业论文25图 4-7 手动程序梯形图4.2.4 回原位程序回原位程序；在系统处于回原位工作状态时，按下回原位按钮（X3） ，M3 变为 ON，机械手松开和上升，当升到上限位（X17 变为 ON） ，机械手后退，直到后限位（X21 为ON）才停止，并且 M3 复位。河北工业大学毕业论文26河北工业大学毕业论文27
