送料机械手设计【毕业论文+CAD图纸全套】

买文档就送您 纸全套， Q 号交流 401339828 或 11970985 摘 要 在当今大规模制造业中，企业为提高生产效率，保障产品质量，普遍重视生产过程的自动化程度，工业机器人作为自动化生产线上的重要成员，逐渐被企业所认同并采用。工业机器人的技术水平和应用程度在一定程度上反映了一个国家工业自动化的水平，目前，工业机器人主要承担着焊接、喷涂、搬运以及堆垛等重复性并且劳动强度极大的工作，工作方式一般采取示教再现的方式。 本文将设计一台四自由度的工业机器人，用于给冲压设备运送物料。首先，本文将设计机器人的底座、 大臂、小臂和机械手的结构，然后选择合适的传动方式、驱动方式，搭建机器人的结构平台；在此基础上，本文将设计该机器人的控制系统，包括数据采集卡和伺服放大器的选择、反馈方式和反馈元件的选择、端子板电路的设计以及控制软件的设计，重点加强控制软件的可靠性和机器人运行过程的安全性，最终实现的目标包括：关节的伺服控制和制动问题、实时监测机器人的各个关节的运动情况、机器人的示教编程和在线修改程序、设置参考点和回参考点。 关键词： 机器人，示教编程，伺服，制动 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 n on of in to As an of of of to of , of in In an is a of of of On I of AQ of be on of to of of in to 文档就送您 纸全套， Q 号交流 401339828 或 11970985 目 录 第 1 章 绪论 3 器人概述 4 器人的历史、现状 4 器人的发展趋势 4 第 2 章 机器人实验平台介绍及机械手的设计 3 由度及关节 4 座及连杆 4 座 7 臂 7 臂 7 械手的设计 4 动方式 4 动方 式 4 动器 4 第 3 章 控制系统硬件 4 制系统模式的选择 4 制系统的搭建 4 控机 4 据采集卡 4 服放大器 4 子板 4 位器及其标定 4 源 4 第 4 章 控制系统软件 4 期的功能 4 现方法 4 时显示各个关节角及运动范围控制 4 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 流电机的伺服控制 4 机的自锁 4 教编程及在线修改程序 4 置参考点及回参考点 4 第 5 章 总结 4 完成的工作 4 计经验 4 差分析 4 以继续探索的方向 4 参考文献 4 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 第 1 章 绪论 器人概述 在现代工业中，生产过程的机械化、自动化已成为突出的主题。化工等连续性生产过程的自动化已基本得到解决。但在机械工业中，加工、装配等生产是不连续的。专用机床是大批量生产自动化的有效办法；程控机床、数控机床、加工中心等自动化机械是有效地解决多品种小批量生产自动化 的重要办法。但除切削加工本身外，还有大量的装卸、搬运、装配等作业，有待于进一步实现机械化。机器人的出现并得到应用，为这些作业的机械化奠定了良好的基础。 “工业机器人”（ 多数是指程序可变（编）的独立的自动抓取、搬运工件、操作工具的装置（国内称作工业机器人或通用机器人）。 机器人是一种具有人体上肢的部分功能，工作程序固定的自动化装置。机器人具有结构简单、成本低廉、维修容易的优势，但功能较少，适应性较差。目前我国常把具有上述特点的机器人称为专用机器人，而把工业机械人称为 通用机器人。 简而言之，机器人就是用机器代替人手，把工件由某个地方移向指定的工作位置，或按照工作要求以操纵工件进行加工。 机器人一般分为三类。第一类是不需要人工操作的通用机器人，也即本文所研究的对象。它是一种独立的、不附属于某一主机的装置，可以根据任务的需要编制程序，以完成各项规定操作。它是除具备普通机械的物理性能之外，还具备通用机械、记忆智能的三元机械。第二类是需要人工操作的，称为操作机（ 它起源于原子、军事工业，先是通过操作机来完成特定的作业，后来发展到用无线电讯号操作机 器人来进行探测月球等。工业中采用的锻造操作机也属于这一范畴。第三类是专业机器人，主要附属于自动机床或自动生产线上，用以解决机床上下料和工件传送。这种机器人在国外通常被称之为“ 它是为主机服务的，由主机驱动。除少数外，工作程序一般是固定的，因此是专用的。 机器人按照结构形式的不同又可分为多种类型，其中关节型机器人以其结构紧凑，所占空间体积小，相对工作空间最大，甚至能绕过基座周围的一些障碍物等这样一些特点，成为机器人中使用最多的一种结构形式，世界一些著名机器人的本体部分都采用这种 机构形式的机器人。 要机器人像人一样拿取东西，最简单的基本条件是要有一套类似于指、腕、臂、关节等部分组成的抓取和移动机构 执行机构；像 肌肉那样 使手臂运动的驱动传动系统；像大脑那样指挥手动作的控制系统。这些系统的性能就决定了机器人的性能。一般而言，机器人通常就是由执行机构、驱动传动系统和控制系统这三部分组成，如图 1示。 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 执 行 机 构机器人控 制 系 统驱 动 - 传 动 系 统手 部腕 部臂 部腰 部基 座 部 （ 固 定 或 移 动 ）电 、 液 或 气 驱 动 装 置单 关 节 伺 服 控 制 器关 节 协 调 及 其 它 信 息 交 换计 算 机图 1器人的一般组成 对于现代智能机器人而言，还具有智能系统，主要是感觉装置、视觉装置和语言识别装置等。目前 研究主要集中在赋予机器人“眼睛”，使它能识别物体和躲避障碍物，以及机器人的触觉装置。机器人的这些组成部分并不是各自独立的，或者说并不是简单的叠加在一起，从而构成一个机器人的。要实现机器人所期望实现的功能，机器人的各部分之间必然还存在着相互关联、相互影响和相互制约。它们之间的相互关系如图 1示。 位 形 检 测控 制 系 统 （ 二 ）驱 动传 动装 置执 行机 构工 作 对 象智 能 系 统控 制 系 统 （ 一 ）图 1器人各组成部分之间的关系 机器人的机械系统主要由执行机构和驱动传动系统组成。执行机构是机器人赖以完成工作任务的实体，通常由连杆和关节组成，由驱动传动系统提供动力，按控制系统的要求完成工作任务。驱动传动系统主要包括驱动机构和传动系统。驱动机构提供机器人各关节所需要的动力，传动系统则将驱动力转换为满足机器人各关节力矩和运动所要求的驱动力或力矩。有的文献则把机器人分为机械系统、驱动系统和控制系统三大部分。其中的机械系统又叫操作机(相当于本文中的执行机构部分。 器人的历史、现状 机器人首先是从美国开始研制的。 1958 年美国联合控制公司研制出第一台机器人。 它的结构特点是机体上安装一回转长臂，端部装有电磁铁的工件抓放机买文档就送您 纸全套， Q 号交流 401339828 或 11970985 构，控制系统是示教型的。 日本是工业机器人发展最快、应用最多的国家。自 1969 年从美国引进两种典型机器人后，大力从事机器人的研究。 目前工业机器人大部分还属于第一代，主要依靠人工进行控制；控制方式则为开环式，没有识别能力；改进的方向主要是降低成本和提高精度。 第二代机器人正在加紧研制。它设有微型电子计算机控制系统，具有视觉、触觉能力，甚至听、想的能力。研究安装各种传感器，把感觉到的信息进行反馈，使机器人具有感觉机能。 第三代机器人（机器人）则能独立地完成工作过程中的任务。它与电子计算机和电视设备保持联系，并逐步发展成为柔性制造系统 和柔性制造单元 中的重要一环。 随着工业机器人研究制造和应用领域不断扩大，国际性学术交流活动十分活跃，欧美各国和其他国家学术交流活动开展很多。国际工业机器人会议 定每年召开一次会议，讨论和研究机器人的发展及应用问题。 目前，工业机器人主 要用于装卸、搬运、焊接、铸锻和热处理等方面，无论数量、品种和性能方面还不能满足工业生产发展的需要。使用工业机器人代替人工操作的，主要是在危险作业（广义的）、多粉尘、高温、噪声、工作空间狭小等不适于人工作业的环境。 在国外机械制造业中，工业机器人应用较多，发展较快。目前主要应用于机床、模锻压力机的上下料，以及点焊、喷漆等作业，它可按照事先制订的作业程序完成规定的操作，但还不具备传感反馈能力，不能应付外界的变化。如发生某些偏离时，就将引起零部件甚至机器人本身的损坏。 随着现代化科学技术的飞速发展 和社会的进步，针对于上述各个领域的机器人系统的应用和研究对系统本身也提出越来越多的要求。制造业要求机器人系统具有更大的柔性和更强大的编程环境，适应不同的应用场合和多品种、小批量的生产过程。计算机集成制造（ 求机器人系统能和车间中的其它自动化设备集成在一起。研究人员为了提高机器人系统的性能和智能水平，要求机器人系统具有开放结构和集成各种外部传感器的能力。然而，目前商品化的机器人系统多采用封闭结构的专用控制器，一般采用专用计算机作为上层主控计算机，使用专用机器人语言作为离线编程工具，采用专用微处理器，并 将控制算法固化在，这种专用系统很难（或不可能）集成外部硬件和软件。修改封闭系统的代价是非常昂贵的，如果不进行重新设计，多数情况下技术上是不可能的。解决这些问题的根本办法是研究和使用具有开放结构的机器人系统。 美国工业机器人技术的发展，大致经历了以下几个阶段： （ 1） 1963为试验定型阶段。 1963， 万能自动化公司制造的工业机器人供用户做工艺试验。 1967 年，该公司生产的工业机器人定型为 1900型。 （ 2） 1968为实际应用阶段。这一时期，工业机器人在美国进 入应用阶段，例如，美国通用汽车公司 1968 年订购了 68 台工业机器人； 1969 年该公司又自行研制出 工业机器人，并用 21 组成电焊小汽车车身的焊接自动线；又如，美国克莱斯勒汽车公司 32 条冲压自动线上的 448 台冲床都用工业机器人传递工件。 （ 3） 1970 年至今一直处于推广应用和技术发展阶段。 1970，工业机买文档就送您 纸全套， Q 号交流 401339828 或 11970985 器人处于技术发展阶段。 1970 年 4 月美国在伊利斯工学院研究所召开了第一届全国工业机器人会议。据当时统计，美国大约 200 台工业机器人，工作时间共达60 万小时以上，与此同时，出现了所谓了高级机器人 ，例如：森德斯兰德公司（ 明了用小型计算机控制 50 台机器人的系统。又如，万能自动公司制成了由 25 台机器人组成的汽车车轮生产自动线。麻省理工学院研制了具有有“手眼”系统的高识别能力微型机器人。 其他国家，如日本、苏联、西欧，大多是从 1967， 1968 年开始以美国的“ “ 机器人为蓝本开始进行研制的。就日本来说， 1967年，日本丰田织机公司 引进美国的“ ,川崎重工公司引进“ 并获得迅速发展。通过引进技术、仿制、改造创新 。很快研制出国产化机器人，技术水平很快赶上美国并超过其他国家。经过大约 10 年的实用化时期以后，从1980 年开始进入广泛的普及时代。 我国虽然开始研制工业机器人仅比日本晚 5，但是由于种种原因，工业机器人技术的发展比较慢。目前我国已开始有计划地从国外引进工业机器人技术，通过引进、仿制、改造、创新，工业机器人将会获得快速的发展。 器人发展趋势 随着现代化生产技术的提高，机器人设计生产能力进一步得到加强，尤其当机器人的生产与柔性化制造系统和柔性制造单元相结合，从而改变目前机械制造的人工操作状态 ，提高了生产效率。 就目前来看，总的来说现代工业机器人有以下几个发展趋势： a)提高运动速度和运动精度，减少重量和占用空间，加速机器人功能部件的标准化和模块化，将机器人的各个机械模块、控制模块、检测模块组成结构不同的机器人； b)开发各种新型结构用于不同类型的场合，如开发微动机构用以保证精度；开发多关节多自由度的手臂和手指；开发各类行走机器人，以适应不同的场合； c)研制各类传感器及检测元器件，如，触觉、视觉、听觉、味觉、和测距传感器等，用传感器获得工作对象周围的外界环境信息 、位置信息、状态信息以完成模式识别、状态检测。并采用专家系统进行问题求解、动作规划，同时，越来越多的系统采用微机进行控制。 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 第 2 章 实验平台介绍及机械手的设计 该设计的目的是为了设计一台 物料搬运 机器人，利用现有已经报废的焊接机器人，本文的中结构设计主要偏向于对原有机构的改造和机械手的设计。 由度及关节 图 1 该机器人具有四个自由度 ，即腰关节、肩关节、肘关节和腕关节，都为转动关节；还有一个用于夹持物料的机械手。 座及连杆 座 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 基座是整个机器人本体的支撑。为保证机器人运行的稳定性，采用两块“ Z”字形实心铸铁作支撑。 基座上面是接线盒子，所有电机的驱动信号和反馈信号都从中出入。接线盒子外面，有一个引入线出口和一个引出线出口。 臂 大臂长度 230体尺寸如图 示： 图 臂外形 臂 小臂长度 240体尺寸如图 示： 图 臂外形 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 械手的设计 工业机器人的手又称为末端执 行器，它使机器人直接用于抓取和握紧（吸附）专用工具（如喷枪、扳手、焊具、喷头等）进行操作的部件。它具有模仿人手动作的功能，并安装于机器人手臂的前端。由于被握工件的形状、尺寸、重量、材质及表面状态等不同，因此工业机器人末端操作器是多种多样的，大致可分为以下几类： （ 1） 夹钳式取料手 （ 2） 吸附式取料手 （ 3） 专用操作器及转换器 （ 4） 仿生多指灵巧手 本文设计对象为 物料搬运 机器人，并不需要复杂的多指人工指，只需要设计能从不同角度抓取工件的钳形指。 手指是直接与工件接触的部件。手指松开和夹紧工件，是通过手指的张开与闭合来实现的。该设计采 用两个手指，其外形如图 示 图 械手手指形状 传动机构是向手指传递运动和动力，以实现夹紧和松开动作的机构。根据手指开合的动作特点分为回转型和平移形。本文采用回转型传动机构。图 初步设计的机械手机构简图（只画出了一半，另外一半关于中心线对称）。 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 图 械手机构简图 在图 ， O 为电机输出轴，曲柄 杆 块 B 和支架构成曲柄滑块机构；滑块 B、连杆 杆 支架构成滑块摇杆机构。通过两个机构串联，使电机最终驱动 来回摆动，从而实现手指的开合运动。 图 的黑线和蓝线表示机构运行的两个极限位置。 为便于手指的顺利合拢，可以在两个手指之间设置一个弹簧，这样还可以提供适当的夹紧力。 另外，在选用电机的时候，要使电机的功率足以克服弹簧的收缩和张开，并且提供足够加紧物体的力。 图 采用虚拟样机软件 分析所设计的机械手机构的工作状况。 图 拟样机场景 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 下面更进一步计算出所需要的电机力矩。 图 矩变化情况 从图 看到，起始阶段须克服的弹簧力最大，电机转矩必须大于550N 为电机的挑选提供了一定的依据。 动方式 该机器人一共具有四个独立的转动关节，连同末端机械手的运动，一共需要五个动力源。 机器人常用的驱动方式有液压驱动、气压驱动和电机驱动三种类型。这三种方法各有所长，各种驱动方式的特点见表 表 种驱动方式的特点对照 内容 驱动方式 液压驱动 气动驱动 电 机 驱动 输出功率 很大，压力范围为50 140，压力范围为 4860大可达 大 利用液体的不可压缩 气体压缩性大，精度 控制精度高，功率较大，买文档就送您 纸全套， Q 号交流 401339828 或 11970985 控制性能 性，控制精度较高，输出功率大，可无级调速，反应灵敏，可实现连续轨迹控制 低，阻尼效果差，低速不易控制，难以实现高速、高精度的连续轨迹控制 能精确定位，反应灵敏，可实现高速、高精度的连续轨迹控制，伺服特性好，控制系统复杂 响应速度 很高 较高 很高 结构性能及体积 结构适当，执行机构可 标准化、模拟化，易实现直接驱动。功率 /质量比大，体积小，结构紧凑，密封问题较大 结构适当，执行机构可标准化、模拟化，易实现直接驱动。功率 /质量比大，体积小，结构紧凑，密封问题较小 伺服电动机易于标准化，结构性能好，噪声低，电动机一般需配置减速装置，除 动机外，难以直接驱动，结构紧凑，无密封问题 安全性 防爆性能较好，用液压油作传动介质，在一定条件下有火灾危险 防爆性能好，高于10000 个大气压 )时应注意设备的抗压性 设备自身无爆炸和火灾危险，直流有刷电动机换向时有火花，对环境的防爆性能较差 对环境的影响 液压系统易漏油，对环境有污染 排气时有噪声 无 在工业机器人中应用范围 适用于重载、低速驱动，电液伺服系统适用于喷涂机器人、点焊机器人和托运机器人 适用于中小负载驱动、精度要求较低的有限点位程序控制机器人，如冲压机器人本体的气动平衡及装配机器人气动夹具 适用于中小负载、要求具有较高的位置控制精度和轨迹控制精度、速度较高的机器人，如 服喷涂机器人、点焊机器人、弧焊机器人、装配机器人等 成本 液压元件成本较高 成本低 成本高 维修及使用 方便，但油液对环境温度有一定要求 方便 较复杂 机器人驱动系统各有其优缺点，通常对机器人的驱动系统的要求有： 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 1）驱动系统的质量尽可能要轻，单位质量的输出功率要高，效率也要高； 2）反应速度要快，即要求力矩质量比和力矩转动惯量比要大，能够进行频繁地起、制动，正、反转切换； 3）驱动尽可能灵活，位移偏差和速度偏差要小； 4）安全可靠； 5）操作和维护方便； 6）对环境无污染，噪声要小； 7）经济上合理，尤其要尽量减少占地面积。 基于上述驱动系统的特点和机器人驱动系统的设计要求，本文选用直流伺服电机驱动的方式对机器人进行驱动。表 选 定的各个关节电机型号及其相关参数。 表 器人驱动电机参数 电机参数 腰关节 肩关节 肘关节 腕关节 手爪 型号 定电压 18v 18v 18v 6v 6v 额定转矩 m m m m m 最大转矩 m m m 额定转速 7980980980460460高转速 转子惯量 9200200200动方式 由于一般的电机驱动系统输出的力矩较小，需要通过传动机构来增加力矩，提高带负载能力。对机器人的传动机构的一般要求有： （ 1）结构紧凑，即具有相同的传动功率和传动比时体积最小，重量最轻； （ 2）传动刚度大，即由驱动器的输出轴到连杆关节的转轴在相同的扭矩时角度变形要小，这样可以提高整机的 固有频率，并大大减轻整机的低频振动； 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 （ 3） 回 差要小，即由正转到反转时空行程要小，这样可以得到较高的位置控制精度； （ 4）寿命长、价格低。 本文所选用的电机都采用了电机和齿轮轮系一体化的设计，结构紧凑，具有很强的带负载能力，但是不能通过电机直接驱动各个连杆的运动。为减小机构运行过程的冲击和振动，并且不降低控制精度，采用了齿形带传动。 齿形带传动是同步带的一种，用来传递平行轴间的运动或将回转运动转换成直线运动，在本文中主要用于腰关节、肩关节和肘关节的传动。 齿形带传动原理如图 示。 齿轮带的传动比计算公式为 2112 齿轮带的平均速度2211 a 图 形带传动 动器 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 制动器及其作用： 制动器是将机械运动部分的能量变为热能释放，从而使运动的机械速度降低或者停止的装置，它大致可分为机械制动器和电气制动起两类。 在机器人机构中，学要使用制动器的情况如下： 特殊情况下的瞬间停止和需要采取安全措施 停电时，防止运动部分下滑而破坏其他装置。 机械制动器： 机械制动器有螺旋式自动加载制动器、盘式制动器、闸瓦式制动器和电磁制动器 等几种。其中最典型的是电磁制动器。 在机器人的驱动系统中常使用伺服电动机，伺服电机本身的特性决定了电磁制动器是不可缺少的部件。从原理上讲，这种制动器就是用弹簧力制动的盘式制动器，只有励磁电流通过线圈时制动器打开，这时制动器不起制动作用，而当电源断开线圈中无励磁电流时，在弹簧力的作用下处于制动状态的常闭方式。因此 这种制动器被称为无励磁动作型电磁制动器。又因为这种制动器常用于安全制动场合，所以也称为安全制动器。 电气制动器 电动机是将电能转换为机械能的装置，反之，他也具有将旋转机械能转换为电能 的发电功能。换言之，伺服电机是一种能量转换装置，可将电能转换为机械能，同时也能通过其反过程来达到制动的目的。但对于直流电机、同步电机和感应电机等各种不同类型的电机，必须分别采用适当的制动电路。 本文中，该机器人实验平台未安装机械制动器，因此机器人的肩关节和轴关节在停止转动的时候，会因为重力因素而下落。另外，由于各方面限制，不方便在原有机构上添加机械制动器，所以只能通过软件来实现肩关节和轴关节的电气制动。 采用电气制动器，其优点在于：在不增加驱动系统质量的同时又具有制动功能，这是非常理想的情况 ，而在机器人上安装机械制动器会使质量有所增加，故应尽量避免。缺点在于：这种方法不如机械制动器工作可靠，断电的时候将失去制动作用。 第 3 章 控制系统硬件 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 制系统模式的选择 构建机器人平台的核心是建立机器人的控制系统。首先需要选择和硬件平台，控制系统硬件平台对于系统的开放性、实现方式和开发工作量有很大的影响。一般常用的控制系统硬件平台应满足：硬件系统基于标准总线机构，具有可伸缩性；硬件结构具有必要的实时计算能力；硬件系统模块化，便于添加或更改各种接口、传感器和特殊计算机等；低成本。到目前为止，一般 机器人控制系统的硬件平台可以大致分为两类：基于 线（ 司 1981 年推出的第一代 32 位工业开放标准总线 ）的系统和基于 线的系统。近年来，随着 性能的快速发展，可靠性大为提高，价格却大幅度降低，以为核心的控制系统已广泛被机器人控制领域所接受。 基于 控制系统一般包括单 制模式， C 的控制模式， 布式控制器的控制模式， 动控制卡的控制模式， 据采集卡的控制模式，由于基于采集卡的控制方式灵活，成本低廉， 有利于本文设计中的废物利用，在程序和算法上可以自主编制各类算法，适合本课题研究的需要。因此本文选定 据采集卡的控制方式。 制系统的搭建 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 图 制系统框图 控机 在此选用研华工业控制机 ,主频 233存 128 兆， 32 位数据总线。底板有 9 个 槽， 4 个 槽，带 示器。其性能价格比优越，兼容性好，有利于软硬件维护和升级。与普通个人计算机相比工业控制 有以下优点： 芯片筛选要比一般个人计算机严格； 芯片驱动能力较强 ； 整机内部结构属于工业加强型，具有较强的防震和抗干扰性能； 对环境（如温度、湿度、灰尘等）的要求要比一般计算机低得多。 据采集卡 在本设计中我们主要用到 研华 公司的 参数如下。 要特点 ： 路单端 12 位模拟量输入 路 12 位模拟量输出 采样速率可编程，最快达 30带 中断的 A/D 路数字量输出 要特点 ： 路独立 D/A 输出 位分辨率双缓冲 D/A 转换器 路数字量输入及 16 路数字量输出 多种电压范围： +/+/0 +5V， 0 +10V 和 4 20流环 。 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 服放大器 在驱动系统设计 过程 中，主要是对 伺服电机 的驱动，本文中利用报废机器人上的 机驱动关节，因此同样选用 服电机驱动器（ 0/2）进行驱动，如图 示，这是专门针对机设计的伺服电机放大控制器，具有很强的控制功能 和稳定性，电源电压 1230v 之间， 1、 2 接线端子接伺服电机，直接给电机供电， 3， 4 接线端与电源相连， 7、 8 接控制电压，通过数据采集卡输出的模拟电压信号进入这两个接线端来控制电机的转速大小和正反转， 13、 14 接测速计（本文中未用）， 3、 4、10 之间是一个光耦合器，输入“准备好”信号。在伺服控制器前面，有 5 个旋钮调节器涌来调节电机的五个参数，下边有 10 个 关，用来选择控制器工作状态。 1234567891 01 11 21 31 41 51 6电 源控 制 电 压测 速 计1234567891 0a i a O f f s e to n o f a x4 k 电 机图 服放大器接线 及其调节示意 子板 不同的被测信号通过不同的传送路线到采集卡，而采集卡在工控机机箱内，不变直接连接到工业系统中的各种传感器或执行器。 端子板的主要作用有两个： 端子板是采集卡与每一个信号调理电路或驱动装置之间的电器连接部件，给买文档就送您 纸全套， Q 号交流 401339828 或 11970985 每一路输入、输出信号提供单独的信号线和地线，使每一路通道可单独接通或断开，系统检修和排除故障时不必全部停止运行。 将每一路信号经过各自的传送路线到达端子板后，可以根据各路信号和传送路线的特点，在端子板上对各路信号进行简单的调理，如经电阻衰减、分流或经过 通滤波 后进入采集卡。 图 示为端子板电路 图 子板电路 图 示的电路图中，为防止直流电机产生的噪声影响电路的正常运行，使用了光电耦合器 4机电一体化技术中，光电耦合电路是重要的接口电路。 其中 过五路数字量输出来控制电机电路的通断， 过五路模拟量输出来控制电机的正反转和运行速度，另外 负责采集五个电位器的电压，以此将电机的运行角度反馈给计算机。 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 位器及其标定 电位器 是一种可调电阻，也是电子电路中用途最广泛的元器件之一。它对外有三个引出端，其中两个为固定端，另一个是中心抽头。转动或调节电位器转动轴，其中心抽头与固定端之间的电阻将发生变化。 本文采用的电位器是单圈的，也就是说各关节的运动角度小于 360，对于该机器人已经足够了。电位器安装在机器人的各个关节输出轴上，所以在关节角的运动范围内，电位计的输出电压和关节角是一一对应的，存在着一定的函数关系。 从理论上来讲，电位器应该是线性的测量元件，但由于电位器的滑动噪声以及滑线电阻的工作过程中的磨损，这种函数关系并非理想的线性 关系，而是存在一定的偏移。电位器的标定就是根据在各个角度处测量的电压值，拟合出一条直线， 近似替代真实的函数关系。 下面即是对各个关节的进行电位计标定。 电位器 1 的标定， 如图 示： 图 位器 关节角 1 与电位计 1 的函数关系： a=位器 2 的标定 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 图 图 示： 关节角 2 与电位计 2 的函数关系： a=位器 3 的标定 图 如图 示： 关 节角 3 与电位计 3 的函数关系： a= 文档就送您 纸全套， Q 号交流 401339828 或 11970985 电位器 4 的标定 图 如图 示： 关节角 4 与电位计 4 的函数关系： a= 位器 5 的标定 图 如图 示： 电机 5 与电位计 5 的函数关系： a= ：以上标定工作都是在 电压下测量的 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 源 电位器和伺服放大器都需要一定的电压，特别是电位计是在 条件下工作的，稳定的电压对于保证电位计反馈信号的真 实性具有重大的影响；而伺服放大器是在 12v30v 范围内工作的，电压只要在此范围内即可。 本文采用 双路稳压稳流电源，可以提供 032v 电压输出和02A 电流输出。 这里设定两路电压输出： 供给伺服放大器运行， 保证电位计的正常工作。 第 4 章 控制系统软件 以上完成了机器人的本体设计和控制系统硬件的搭建，下面将通过设计控制软件，使计算机通过数据采集卡有条不紊地向外部发送指挥信号，最终驱动机器人各个关节的运动，使之按照人的意愿“工作”。 期的功能 （ 1） . 实时显示各个关节角，并且可以防止各个关节的运动角度超出预定的关 节角范围内； （ 2） . 实现直流电机的伺服控制； （ 3） . 实现电机的自锁； （ 4） . 实现示教编程及在线修改程序； （ 5） . 可以设置参考点，使机器人在空间有一个固定的参考位置，可以回参考 点。 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 现方法 以模块化程序设计思想为指导，以预期要实现的 功能 作为各个模块，设计控制软件。 从图 以看出，工控机通过数据采集控制 。编程的任务其实就是用计算机控制数据采集卡使之发出或获取一系列数 字量、模拟量。 研华 公司的数据采集卡驱动程序中，附带许多与板卡相关的函数和数据结构以供使用，极大的方便了程序编写。 本文采用了 +作为编程工具。 时显示各个关节角及运动范围控制 在 函数中， 设置定时器 , 然后在 数中， 通过调用 采样电位器输出电压，通过前面的电位器标定函数，换算出各个关节的角度，并显示出来。 在 函数中（ ?表示 1， 2， 3， 4， 5）， 将换算出的角度与该关节预设的运动范围作比较，看其是否在此区间内，否则弹出警告对话框，并且自动停止该关节的运动。 流电机的伺服控制 对于大功率的直流电机，一般采用 制来调节运行速度，这样可以提高电路及电机的运行效率，而本文中的电机功率并不是很大，为方 便期间，采用了线性控制方法来调速。 以关节 1 为例，与该 模块 相关的函数有 , , ，它们分别表示用来控制电机的正转、反转和停止，其中电机的运行速度靠输入的电压值调节；另外一个函数 是用来实现电机的位置伺服控制，在预定的关节角范围内，电机可以运行到任何一输入的位置停止。 机的自锁 买文档就送您 纸全套， Q 号交流 401339828 或 11970985 前面在 中讲到该机器人关节上未装制动器，所以必须通过软件程序实现关节的自锁，尤其是肩关节和肘关节的自锁。 解决思路：大 臂和小臂在电机运转时不会由于重力而掉落，在电机停止的时候却会下落，因为电机一旦停止，就失去了驱动力矩，因此若想让大臂和小臂停止在预定位置，应该在此位置给关节电机施加一个电压，让它担负起大臂或小臂，而不让其由于重力而下落。但是，在不同的位置，重力对大臂或小臂的力矩不同，应提供给电机的电压也不同，如何选取电机的电压呢？ 提供给电机的电压小了，不足以抵抗重力的力矩；提供给电机的电压大了，会使电机转动，使大臂或小臂上升；所以，最好能通过程序来自适应选择这个制动电压，方法有多种，下面是本文的设计过程。 程序设计方法一 ： 在调用在 或 函数时，先给电机一个 0 电压，使电机失去驱动力矩，同时调用 数获得此刻的关节位置，然后延时一段时间比如 给电机一个小电压，形成一个小的制动力矩，通过采样此刻位置看其是否能使关节制动；如果不能，则使该电压值按照一定的步长线性增加，以增大制动力矩；这通过一个 循环实现，如果采样位置不再减小，则表示大臂或小臂已停止下落，可跳出循环。 下图为程序流程图： 方法一验证： 调用 或 函数 使电机电压为 0，并采样此时位置，将电位器输出值存放在 考虑到大臂或小臂上升时的惯性， 循环采样一直到采样值 出循环，表示大臂或小臂已经