工业机械手运动设计

1、工业机械手运动设计任务书1. 设计的主要任务及目标综合分析和解决本专业问题的独立工作能力，拓宽和深化学生的知识。树立正确的设计思想和使用技术资料、国家标准等手册、图册工具书进行设计计算，数据处理，编写技术文件等方面的工作能力。2. 设计的基本要求和内容通过查阅文献了解机械手的工作原理，机械手的常见控制程序及方法等信息 结合模块化六自由度机械手，对七自由度机械手的运动设计完成相关工作。3. 主要参考文献1 徐达及.工业机器人应用工程.M冶金工业出版社，1999.2 徐元昌.工业机器人.M中国轻工业出版社，1999.3 程宪平.机电传动与控制（第三版）.M华中科技大学出版社，2010.94 孙恒.

2、陈作模，葛文杰.机械原理（续）.M煤炭工程，19884.进度安排设计（论文）各阶段名称起止日期毕业论文准备2013年9月10日-2014年11月1日确定论文选题2013年11月1日-2014年12月1日开题（提交开题报告及任务书）2013年3月1日-2014年3月10日中期检查、修改及订稿2013年4月26日-2014年6月5日进行毕业答辩2013年6月22日-2014年6月23日工业机械手的运动设计摘要：现代工业中，生产过程的机械化，自动化已成为突出的主题。化工等连续性生 产过程的自动化已基本得到解决。但在机械工业中，加工、装配等生产是不连续的。因此， 装卸、搬运等工序机械化的迫切性， 工业

3、机械手的运动设计为实现这些工序的 自动化而显得尤为重要。机械手通常是由一系列连杆和相应的运动副组合而成的空间开式链， 实现复杂的 运动， 完成规定的操作。 本次设计运用机器人运动学， 描述这些连杆之间以及它们和 操作对象（工件或工具 ）之间的相对位置关系， 建立空间坐标系。 机械手坐标系建立的 方法常用的是 D-H 方法。通过求逆解得出所需结果。关键词： 机械手，模块化，运动设计Industrial robot motion designAbstract: The modern industry, the production process of mechanization and auto

4、mation has become a prominent theme. Chemical and other continuous production process automation has been largely resolved. But in the machinery industry, processing, assembly and other production is not continuous. Therefore, handling, transport and other processes of the urgency of mechanization,

5、industrial robot motion design is to achieve the automation of these processes is particularly important.Robot is usually caused by a series of connecting rod and the corresponding kinematic pair combination space open chain, to achieve complex motion and complete the operation.The use of robot kine

6、matics design, by describing the operation of the link between them and the object and (workpiece or tool) the relative positional relationship between the established space coordinates. Robot coordinate system established methods commonly used method D-H. Obtained by calculating the inverse desired

7、 results.Keywords: robot, modular, motion design1目录I1 绪论1.1机械手简史1.2工业机械手的分类及组成1.3工业机械手系统1.4模块化机械手的作用及不足1.5机械手应用意义及研究内容2 七轴新型智能机械人手臂2.1 EF-IRC-I机械手应用前景及应用领域2.2 EF-IRC-I机械手相关参数102.3 EF-IRC-I机械手特色1.1.2.4 EF-IRC-I七轴机器手设备说明122.4.1 七个关节的名称、位置及动作122.4.2 机器人技术参数142.5 EF-IRC-I 机器人状态与编程步骤152.5.1 输出转矩相关概念162.5

8、.2 运动控制相关状态173 机器人坐标系及运动学分析183.1 建坐标系原理及步骤183.2 机器人运动学分析233.2.1 机器人运动学原理233.2.2 机器人运动学步骤243.3 机器人逆运动学分析274 实验仿真31结论35参考文献36致谢371 绪论工业机械手是指附属于主机、程序固定的自动抓取、操作装置(国内一般 称作机械手或者专用机械手) ，是近代自动控制领域中出现的一现新技术，并已 成为现代机械制造生产系统中的一个重要组成部分，这种新技术发展很快，逐 渐形成一门新兴的学科机械手工程。机械手能自动控制并可从新编程以变动的多功能机器 1 ，他有多个自由度， 可以搬运物体以完成在不同

9、环境中的工作。 机械手的结构形式开始比较简单， 专用性较强。 随着工业技术的发展，制成了能够独立的按程序控制实现重复操 作，适用范围比较广的“程序控制通用机械手” ，简称通用机械手。由于通用机 械手能很快的改变工作程序，适应性较强，所以它在不断变换生产品种的中小 批量生产中获得广泛的引用。 现代工业机械手起源于 20世纪 50年代初，是基 于示教再现和主从控制方式、能适应产品种类变更，具有多自由度动作功能的 柔性自动化产品。机械手的迅速发展是由于它的积极作用正日益为人们所认识：其一，它能 部分代替人工操作；其二，它能按照生产工艺的要求，遵循一定的程序，时间 和位置来完成弓箭的传送和装卸；其三，

10、它能操作必要的机具进行焊接和装配， 从而大大地改善工人的劳动条件，现住地提高劳动生产率，加快实现工业生产 机械化和自动化的步伐 .因而，受到先进工业国家的重视，投入大量的人力物力 加以研究和应用，尤其是在高温，高压，粉尘，噪音以及带有放射性和污染的 场合，应用得更为广泛。在我国，近几年来也有较快的发展，并取得一定的效 果，收到机械工业和其它工业部门的重视。1.1 机械手简史1958 年美国联合控制公司研制出第一台机械手。(1) 1954年USA工程师德尔沃最早提出机械人的概念；(2) 1959年USA德尔沃与英格伯制造了世界上的第一台机械人；(3) 1962年USA正式将机械人的使用性提出来，

11、且制造出类似人的手臂;（4）1967年JAN成立了人工手研究会，并召开了首届机械手学术会；（5）1970年在USA召开了第一届工业机械人学术会，并的到迅速普及；（6） 1973年辛辛那提公司制造出第一台小型计算机控制的的工业机械人，当时 是液压驱动，能载重大成就45KG（7）到1980年在JAN得到普及，并定为“机械人元年”此后在日本机械人得 到了前所未有的发展与提升，在就是后来到台湾再到大陆。第二代机械手正在加紧研制。它设有微型电子计算机控制系统，具有视觉、 触觉能力，甚至听、想的能力。研究安装各种传感器，把感觉到的信息反馈， 使机械手具有感觉机能。目前国外已经出现了触觉和视觉机械手。第三代

12、机械手（机械人）则能独立地完成工作过程中的任务。它与电子计 算机和电视设备保持联系。并逐步发展成为柔性制造系统FMS（Flexible Manufacturing system和柔性制造单元（Flexible Manufacturing Cell）中重要一环。 随着工业机器手（机械人）研究制造和应用的扩大，国际性学术交流活动十分 活跃，欧美各国和其他国家学术交流活动开展很多。1.2工业机械手的分类及组成机械手一般分为三类2:第一类是需要人工操做的，称为操作机，如图2.1。 它起源于军事工业，先是通过操作机来完成特定的作业，后来发展到用无线电 讯号操作机来进行探测月球等。工业中采用的锻造操作机也

13、属于这一范畴。图1.1 操作机械手第二类是不需要人工操作的通用机械手，如图 2.2。它是一种独立的不附属 于某一主机的装置。它可以根据任务的需要编制程序，以完成各项规定的操作。 它的特点是具备普通机械的性能之外，还具备通用机械、记忆智能的三元机械。1 一bls图2.2 通用机械手图2.3模块化机械手45主要附属于自动机床或自动线上，用以解决机床第三类是用专用机械手，上下料和工件送如图2.3。它是为主机服务的，由主机驱动；除少数以外，工作程序一般是固定的，因此是专用的。本次运动设计所用的机械手为第三类（模块化机械手）工业机械手主要由执行系统、驱动系统和控制系统三大部分组成组成关系3 如下：1.3

14、工业机械手系统45 0工业机械手系统主要分为执行系统和驱动系统以及控制系统执行系统执行系统是工业机械手完成握取工件(或者工具)实现所需的各种运动的 机械部件，包括以下几个部分：(1) 手部：是工业机械手直接与工件(或者工具)的部件。有些工业机械手 直接将工具(如焊枪、喷枪、容器)装在手部位置，而不再设置手部。(2) 腕部：是工业机械手中联接手部与臂部、主要用来确定手部工作位置并 扩大臂部动作范围的部件。有些专用机械手没有手腕部件，而是直接将手部安 装在臂部的端部。(3) 臂部：是工业机械手用来支承腕部和手部实现较大运动范围的部件。(4) 机身：是工业机械手用来支承手臂部件，并安装驱动装置及其他

15、装置的 部件。专用机械手一般将臂部装在主机上，成为主机的附属装置。驱动系统驱动系统是向执行系统各部件提供动力的装置。采用的动力源不同，驱动 系统的传动方式也不同。驱动系统的传动方式有四种 :液压式、气压式、电气式 和机械式。(1) 液压式：液压驱动主要是通过油缸、阀、油泵和油箱等实现传动。它利 用油缸、马达加上齿轮、齿条实现直线运动 6 ；利用摆动油缸、马达与减速器、 油缸与齿条、齿轮或链条、链轮等实现回转运动。液压驱动的优点是压力高、 体积小、出力大、运动平缓，可无级变速，自锁方便，并能在中间位置停止。 缺点是需要配备压力源，系统复杂成本较高。(2) 气压式：气压驱动所采用的元件为气压缸、气

16、压马达、气阀等。一般采 用 4-6 个大气压，个别的达到 8-10 个大气压。它的优点是气源方便，维护简单， 成本低。缺点是出力小，体积大。由于空气的可压缩性大，很难实现中间位置 的停止，速度不易控制、响应慢、动作不平稳、有冲击，只能用于点位控制， 而且润滑性较差，气压系统容易生锈。为了减少停机时产生的冲击，气压系统 装有速度控制机构或缓冲机构。(3) 电气式：其驱动系统一般是由电机驱动。现在都用三相感应电动机作为 动力，用大减速比减速器来驱动执行机构；直线运动则用电动机带动丝杠螺母 机构；有的采用直线电动机。优点是电源方便，信号传递运算容易、响应快、 驱动力较大，适用于中小型工业机械手。但是

17、必须要使用减速机构(如齿轮减 速器、谐波齿轮减速器等) ，所需要的电机有步进电机、 DC 伺服电机和 AC 伺 服电机等。(4)机械式：其驱动系统由电机、齿轮、齿轮齿条、连杆等机械装置组成，传动可靠，适用于专一简单的机械手。这种方式结构比较庞大。控制系统控制系统是工业机械手的指挥系统，它控制驱动系统，让执行系统按照规 定的要求进行工作，并检测其正确与否。一般常见的为电气与电子回路控制， 计算机控制系统也不断增多。就其控制方式，可分为分散控制与集中控制两种 类型。若以控制的运动轨迹来分，原则上分为两种 78 ：(1) 点位控制：主要控制空间两点或者有限多个点的空间位置，而对其运动 路径没有要求。

18、专用机械手绝大多数均采用这种点位控制方式。为本机械手的 控制方式。(2) 连续轨迹控制：是用连续的信息对运动轨迹的任意位置进行控制，其运 动轨迹是连续的。对运动轨迹有要求的工业机械手需要连续轨迹控制，如电弧 焊、切割等。1.4 模块化机械手的作用及不足最终要获得能基本满足各种不同功能的需要模块化的功能是由各模块组合后体现的，故不同功能模块经组合后体现不 同的功能。总的来说，模块系统是多功能的，这种不同的功能，也可以体现在 性能的不同 9 。模块化的可分性 模块化系统可分为若干个模块，而每个模块均有其独立性，可用计算机对 模块库进行建立和管理，也非常有利于维修。模块化的作用如下几点 ：1)2)5

19、)6)由原单一功能产品变成多功能产品； 便于应用 CAD 等成组技术； 增加批量，降低成本，大大缩短设计、生产、制造周期； 便于计算机管理；增强在国际市场的竞争能力； 便于产品的更新换代。目前实现功能及不足 :目前该机械手能运动如下： 单个模块的控制运动； 速度模式下的单个模块运动； 位置模式下的单个模块运动； 只能在复位时候进行连续运动； 目前机械手臂能让同学们认识工业机械手控制系统的控制原理和机2)3)4)(5) 械手运动的原理。(6)现在由于该机械手臂不能连续运动，不能符合工业生产线上的要求， 但是该机械手的二次开发空间非常大，我们可以根据自己的想法来编写相应程序进行二次开发，让它符合我

20、们要求的循环运动，从而符合工业上的要求。1.5 机械手应用意义及研究内容机械手的应用意义可以概括如下 10 ：(1)以提高生产过程中的自动应用化程度应用机械手有利于实现材料的传送、工件的装卸、刀具的更换以及机器的 装配等的自动化的程度，从而可以提高劳动生产率和降低生产成本。(2) 以改善劳动条件，避免人身事故 在高温、高压、低温、低压、有灰尘、噪声、臭味、有放射性或有其他毒性污染以及工作空间狭窄的场合中， 用人手直接操作是有危险或根本不可能的， 而应用机械手即可部分或全部代替人安全的完成作业，使劳动条件得以改善。 在一些简单、重复，特别是较笨重的操作中，以机械手代替人进行工作，可以 避免由于操

21、作疲劳或疏忽而造成的人身事故。(3) 可以减轻人力，并便于有节奏的生产应用机械手代替人进行工作，这是直接减少人力的一个侧面，同时由于应 用机械手可以连续的工作，这是减少人力的另一个侧面。因此，在自动化机床 的综合加工自动线上，目前几乎都是机械手，以减少人力和更准确的控制生产 的节拍，便于有节奏的进行工作生产。现代工业中，生产过程的机械化，自动化已成为突出的主题。化工等连续 性生产过程的自动化已基本得到解决。但在机械工业中，加工、装配等生产是 不连续的。因此，装卸、搬运等工序机械化的迫切性，工业机械手就是为实现 这些工序的自动化而产生的。机械手在锻造工业中的应用能进一步发展锻造设备的生产能力，改

22、善热、 累等劳动条件。国内机械手工业、铁路工业中首先在单机、专机上采用机械手上下料，减 轻工人的劳动强度。研究内容 本次毕业设计主要针对模块机械手进行系统的运动设计，对照工业生产线 上的机械手的工作模式进行模拟，主要工作内容：(1)通过查阅有关资料，详细了解工业机械手的各个部分，并通过了解机械手的工作原理，知道在机械手运动过程中的相互联系。（2）机械手的运动设计。机械手通常是由一系列连杆和相应的运动副组合而成的空间开式链，实现复杂的运动，完成规定的操作。因此，机器人运动学 描述的第一步，自然是描述这些连杆之间以及它们和操作对象 （工件或工具 ）之间 的相对运动关系。假定这些连杆和运动副都是刚性

23、的，描述刚体的位置 和姿态 （简称位姿 ）的方法基于 D-H 矩阵：首先规定一个直角坐标系， 相对于该坐标系， 点的位置可 以用3维列向量表示；刚体的方位可用 3X3的旋转矩阵来表示， 而4X4的齐次变换矩阵则可 将刚体位置和姿态（位姿）的描述统一起来。通过运 动学相关知识，即可得出逆解，完成相关工作。2 七轴新型智能机械人手臂2.1 EF-IRC-I 机械手应用前景及应用领域EF-IRC-I 机械手是一种由一套具有各种尺寸和性能特征的可交替的模块组 成的智能机械手，能够被装配成各种不同构型的机器人。 EF-IRC-I 机械手为串 联关节式机器人，串联关节式机器人是当今工业领域在汽车、焊接、码

24、垛等领 域应用最为广泛的工业机器人类型，而模块化机器人正是体现工业串联机器人 的特征与功能 11。EF-IRC-I 机械手是一种典型的工业机器人，在自动搬运、焊接、喷涂、装 配等工业现场中有着广泛的应用。模块化设计方法在技术上和经济上都体现了 强大的优势，模块化具有独立性、功能性、成组性的优点，其组合具备很强的 目的性、灵活性、经济性的特点，模块接口在互换性的基础上兼顾界面稳定性 与参数的一致性，模块化设计能减少工作量、缩短研制周期减少生产成本以及 改善系统，易于维护，因此模块化设计方法在机器人技术中得到了广泛应用并 取得很好的效果。EF-IRC-I 机械手具有极其广泛的应用领域：(1) 工业

25、机器人领域EF-IRC-I 机械手可方便的拓展工业生产线用机械手，用于完成某一重复性 的操作动作，并进而降低劳动力成本及人为失误，降低人工作产生的危险动作 系数。(2) 拟人机械手EF-IRC-I 机械手可作为一个独立的系统和拟人机器人相配合，作为机器人 的手臂完成人类手臂同等的各种简单及复杂的操作，用于老人或病人的辅助护 理工作。(3) 特殊环境的操作EF-IRC-I 机械手可安装在移动载体上，通过无线控制使其达到人类难以胜 任的环境进行操作任务。根据安装的不同末端控制器件， EF-IRC-I 机械手可完成诸如“抓、放、拧、定、贴、擦、刮、喷刷”等动作。(4) 配合视觉系统的自主操作EF-I

26、RC-I机械手可配置一套视觉系统，从而进一步提高系统的智能化程度,使其能够完成高复杂度的自主判断动作。(5)教学科研系统利用系统配备的上述SDK软件包，EF-IRC-I机械手可作为教学、科研设备,用于机器人的教学及算法研发。2.2 EF-IRC-I机械手相关参数模块数:！总组合自由晨豹驱动方式采用高品馬PMDC伺服齿轮;1速2达* 高性能，高智能执行器能够反馈位 速度、电压不匡昌度的信息*总组合膜块化机署人可搬质量气动手爪1. Ok?杲大动作范围肩基咄关节aoo'*肩慚卬1E0'肩偏航：5呃"肘俯仰仙“腕偏航泅“腕俯仰加酹瓠定负荷1000克最大有效负荷1200克额定速

27、度米，'蔽高旳厘米i审展4S厘米 重复精度0Z厘米图2.5 机械人手臂相关参数EF-IRC-I机械手是机器人研发的最新成果，它是一种创新的具有7自由度机械手结构。由7个基本模块组成，模块从1到7关节逐节组合。每一个模块单独可以控制运行，7个模块组合之后构成工业串联关节机器人形式。EF-IRC-I机械手末端安装手抓，取放工作、装配操作等任务。其杰出设计利用多自由度结构运动学优越性，使手臂能在三维立体空间内做出各种类似人类手臂的弯曲、 伸展动作，进而避开障碍物完成任务。EF-IRC-I机械手的各个关节可独立控制 以确保手臂运动的流畅性、快速性、精确性及可重复性。2.3 EF-IRC-I 机

28、械手特色（1）开发式驱动及执行器结构EF-IRC-I机械手关节采用高品质PMDC伺服齿轮减速马达组成。PMDC伺服齿轮减速马达具有高性能、高精度、高扭矩特点的同时还具备能够实时反馈电机位置、速度、电压和温度等重要信息，便于7轴机器人能够实现高精度控制的最有闭环系统设计。EF-IRC-I机械手采用模块化设计，组合拆装方便。（2）灵活的电子控制EF-IRC-I机械手内置有一个通道伺服控制器，除了用于控制7个自由度的操作外，多余的通道可以用来控制其他的末端设备。多通道伺服控制器可通过 USB接口、由网络或无线网络通讯接和PC进行通讯以完成系统仿真及置配操作。整体控制灵活，方便二次开发。（3）完善的教

29、学开发环境EF-IRC-I机械手系统软件包括一个3D（3维立体视觉）GUI （图形学生接 口）软件包，XML列表软件包及 SDK软件包。3D GUI软件包给学生一个 EF-IRC-I机械手系统的3维立体图形仿真环境12。Jn1图2.6机械手3维立体仿真环境(4) 教学特点EF-IRC-I机械手在原有技术上增设多种控制模式一软件控制、编程控制、手动控制，3D仿真，真正实现控制的多样化，能够熟练掌握其结构、原理。2.4 EF-IRC-I七轴机器手设备说明EF-IRC-I机械手技术参数Energid七轴机械手臂由7个关节和一个抓手组成。实现关节和抓手功能的 硬件是舵机，因此，Energid七轴机械臂

30、有8个舵机。通过程序直接控制这 8个 舵机，可以让机械手做出类似于人手的各个动作。241七个关节的名称、位置及动作能黄韦施藝iZIbm? EfiU).图2.7机械手臂七个关节的名称、位置及动作顺关节仰W t的StPtil).Ft关节刪qj （EDbfjwmi（HIM爛璃”縫per）根据7个关节的旋转轴线，结合下图就能够直观的想象出机械臂各个关节在空 间的动作，从而能够理解关节动作术语的直观意义。关节与关节之间的连接称之为 LINK，根据D-H参数表达方法，LINK的编号从0开始，关节的编号从1开始13 0砒节«輕m 7 （Join?）.聽沖节fhp IWPldic 关节 6 （Joi

31、ned .聽黄节侗航（VftEtVw关T 5山丘第，LIHE4.,时背节fff® （E3b（w Pid止戋节4 口血4）.LIHE2+ 1IHE.I於茂节确切1 swiff Pidi）：丸节2 （】血2）rt克节賞转tEttxwmz知3（用竝菇.LIHB5+LIHK7,LIHKfl.,眉帅（1爛（aifflilderEDlO；如（JwntD .FK_141"（122.'-_一du仰桃亦SJ,F? USB|#D（ESE2）SO i|图2.8机械手臂各关节旋转轴线以及尺寸（单位:mm表2.1关节角度限制关节名称顺时针角度限制逆时针角度限制单位（度）单位（弧度）单位（度）

32、单位（弧度）肩关节旋转Shoulder Roll348*C348*R3748*C3748*R肩关节俯仰Shoulder Pitch788*C788*R3308*C3308*R肘关节旋转ElbowRoll348*C348*R3748*C3748*R肘关节俯仰ElbowP itch788*C788*R3308*C3308*R腕关节偏航WristYaw788*C788*R3308*C3308*R腕关节俯仰WristP itch848*C848*R3248*C3248*R腕关节旋转WristRoll348*C348*R3748*C3748*R手指004095*C4095*R242机器人技术参数1)2)

33、3)4)机械手臂垂直最大长度：53.4cm （从基座到顶端）机械手臂水平最大长度：48cm重复性位置精度：+/-0.5mm手指最大张度：3.5cm说明：系数C=360-4096 ;系数 R=2Xn- 4096;表2.2七轴机械手臂标准D-H参数表LINKalp haAthetaDJoint typeOffset an gle1n /200120R02n /2000R03-n /200140.8Rn4-n /271.800Rn /25n /271.800Rn6-n /2000Rn /27000139.6R0说明:Alpha : a角，Link twist , D-H参数标准名称。表中单位为弧度.

34、A: Link length , D-H参数标准名称，表中单位为毫米。Theta: 0角，Joi nt an gle，D-H参数标准名。表中单位为弧度。D: Joi nt dista nee，D-H参数标准名称。表中单位为毫米。关节类型：R表示关节是旋转关节。Offset angle :表示各关节角度偏移。2.5 EF-IRC-I机器人状态与编程步骤EF-IRC-I机器人存在三种状态，即：通信状态、报警状态及控制状态。通 讯状态使应用程序对虚拟串口的访问为对串口硬件的访问。报警状态使机器人 能够自我监测与保护，内部有许多传感器用于检测位置、电机的转速、工作电 压、电机的工作温度等。控制状态使参

35、数为精确高效控制机器提供强大的信息 反馈。机械手臂与PC机KJUS0连接屮图2.9机器人与计算机连接图Power Ibe机手臂内部耽机彳(1)(2)机器人由七个关节及一个手爪组成，每个内部都是一个高精度的舵机。舵机 的参数如下： 微控制器：ST CORTEX-M3 ( STM32F103C8 72MHZ,32BIT)(3电机：Maxon(4)波特率：8000 bps - 4.5 Mbps(5)控制算法：PID(6)分辨率：0.088°(7)重量:72克(8)尺寸:35.6mm x 50.6mm x 35.5mm(9)减速比：193 :(10)堵转转矩:2.3N.m (at 11.1V

36、 1.3A),位置传感器：非接触式绝对编码器(12位，360度)2.5N.m (at 12V 1.4A)3.1N.m (at 14.8V 1.7A)(11)空载转速:50rpm (at 11.1V)55rpm (at 12 V)(12)67rpm (at 14.8V)工作温度：5C - +80 r(13)电压：10 - 14.8V (推荐电压12V)(14)控制方式:数字通信包(15)协议类型:半双工异步串行通信(8bit,1stop, No Parity)(16)物理连接:T (TTL Level Multi Drop Bus)R (RS485 Multi Drop Bus)(17)ID :

37、 254 ID (0253)(18)(19)反馈：位置，温度，负载，输入电压等。材料：全金属齿轮(20)待机电流：100 mA2.5.1输出转矩相关概念转矩参数基本关系:限制输出转矩】最大输出转矩】(1) 【当前输出转矩】W堵转转矩】(2) 【限制输出转矩】w(3) 【最大输出转矩】w机械臂上电后，机械臂转矩参数的初始化方法 :(1)【最大输出转矩】初始化为堵转转矩的 100%。 ( 2)将【最大输出转矩】的值拷入【限制输出转矩】 。( 3)【允许输出转矩】初始化为“否” ，即机械臂处于 转矩输出禁止 工作 状态。有两种方法将机械臂恢复到初始状态：(1 )机械臂重新上电(2)软件控制将机械臂恢

38、复到 转矩复位 工作状态。 注：当电机发生过热停机后，需要至少 20 分钟的冷却时间才能继续重新工作。2.5.2 运动控制相关状态(1)位置机器人使用 12 位的高精度角度传感器检测转动的绝对位置， 将圆周 360 度 等分成了 4096 份，其角度精度为 0.088 度。即将所读取到的数字量， 乘以 0.088 ， 即转换为实际的角度位置。目标位置：命令关节需要达到的位置。当前位置：关节当前所处的位置，在运动过程中，这个值在不断变化 , 是否 到达目标位置：用于检测舵机是否到达目标位置。( 2)速度目标速度：舵机以多大的速度进行转动。数值范围： 0 到 1023，单位是 0.114rpm(r

39、pm: 每分钟多少转)。如果设置为 0，表示电机以最大转速转动。如 果为 1023，则转速为 1 1 7.07rpm。当前速度：数值范围： 0 到 2047。单位为 0.11rpm 。如果为 0 到 1023，表示逆时针方向的转速。如果为 1024 到 2047，表示顺 时 针 方向 的转 速 。这 时计 算 转 速 ，需 要 先减 去 1024， 然后 再乘 以0.11rpm1415 。3机器人坐标系及运动学分析3.1建坐标系原理及步骤建坐标系原理机器人通常是由一系列连杆和相应的运动副组合而成的空间开式链，实现 复杂的运动，完成规定的操作。因此，机器人运动学描述的第一步，自然是描 述这些连杆

40、之间以及它们和操作对象 （工件或工具）之间的相对运动关系。假定 这些连杆和运动副都是刚性的，描述刚体的位置和姿态（简称位姿）的方法是这样的：首先规定一个直角坐标系，相对于该坐标系，点的位置可以用3维列向量表示；刚体的方位可用3X 3的旋转矩阵来表示，而4 X 4的齐次变换矩阵则 可将刚体位置和姿态（位姿）的描述统一起来。机器人的每个关节坐标系的建立 可参照以下的三原则16:（1）Zni轴沿着第n个关节的运动轴；（2）Xn轴垂直于Zn 1轴并指向离开Zn 1轴的方向；（3）y轴的方向按右手定则确定。机器人坐标系建立的方法常用的是 D-H方法，这种方法严格定义了每个关 节的坐标系，并对连杆和关节定

41、义了 4个参数，如图：机器人机械手是由一系列连接在一起的连杆（杆件）机构构成的。需要用两个参数来描述一个连杆，即公共法线距离 ai和垂直于ai所在平面内两轴的夹角ai ;需要另外两个参数来表示相邻两杆的关系，即两连杆的相对位置di和两连杆法线的夹角 i 。除第一个和最后一个连杆外，每个连杆两端的轴线各有一条法线，分别为 前、后相邻连杆的公共法线。这两法线间的距离即为di。我们称ai为连杆长度，ai 为连杆扭角， di 为两连杆距离 , i 为两连杆夹角。机器人机械手上坐标系的配置取决于机械手连杆的连接类型。 有两种连接， 即转动关节和棱柱联轴节。对于转动关节，1为关节变量。连杆i的坐标系原点

42、位于关节i和i+1的公共法线与关节i+1轴线的交点上。如果两相邻连杆的轴 线相交于一点，那么原点就在这一交点上。如果两轴线互相平行，那么就选择 原点使对下一连杆（坐标原点已确定）的距离 dii为零。连杆i的z轴与关节 i+1的轴线在一直线上，而X轴则在关节i和i+1的公共法线上，方向是从i指 向i+1，当两关节轴线相交的时候，X轴的方向与两矢量的交积Zi 1 *Zi平行 或反向平行，X轴的方向总是沿着公共法线从转轴n指向i+1 0当两轴Xi 1和Xi 平行且同向时，第i个转动关节的i为零。一旦对全部连杆规定坐标系之后，我们就能够按照下列顺序由两个旋转和 两个平移来建立相邻两连杆i-1与i之间的

43、相对关系。移到与 Xi 同一直线上。 的坐标系移到使其原点与连杆 n 的坐标系转到与 Zi 同一直线上。相对位置的四个齐次变换来描述， 并叫做绕乙1轴旋转i角，使Xi 1轴转到Xi与同一平面内。 沿 Zi 1 轴平移一距离 di ，把 Xi 1 沿 i 轴平移距离 ai ，把连杆 i-l 原点重合的地方。绕 Xi 1 轴旋转 i 1 角，使 Zi 1 这种关系可由表示连杆 i 对连杆 i-1Ai 矩阵。此关系式为：式 3.1 )Ai Rot(Z, i )Trans (0,0,di)Trans ( ai ,0,0) Rot (x, ai )展开上式得：i1Aicos isin i00sin i

44、cos icos i cos isin i0sin sin i cos i sin icos i0ai cos iai sin idi1（式 3.2）当机械手各连杆的坐标系被规定之后，就能够列出各连杆的常量参数。对于跟在旋转关节i后的连杆，这些参数为a , ii和aii。对于跟在棱柱联轴 节i后的连杆来说，这些参数为i和ii 0然后，角的正弦值和余弦值也可计算出来。这样A矩阵就成为关节变量d的函数（对于旋转关节）或变量d的 函数（对于棱柱联轴节）。一旦求得这些数据之后，就能够确定六个 A变换矩阵 的值1718 0建坐标系步骤参照机器人的运动机构简图，根据根据运动图3.2建坐标系：D-H方法建立

45、机器人的坐标系。;2*L阴 + IIHIG ,腕黄节僵勒貨节丁 5皿竹.LINKfi+ LINK?朋关节恸K （WtiftYawK黄节J （JQ蚯幻LIHK1 .LIKED ,（也；上打丿；a .1T 二一I険黄节仰何艾节6 (Joints).,G I S4,甘关节tfffW (ElbowPitch)；黄节4 CJcmLi)r 射关节離揀戲师刘Uh关节3就站.眉关节睛何(SkJuldffPiuhl丸节2 (JamLU肩关节旋黑(SJvjulisrRolD： 1 (Ml)图3.2机器人运动机构简图杆件变量为转角0 n偏距dn (mm)扭角an杆长an (mm)1012090°02009

46、0°030140.8-9000400-90071.850090071.8600-900070129.600表3.1坐标系各变量的值建立i-1 A矩阵(3)根据机械臂的各个变量的值以及各杆件之间关系,cos isin i cos isin sin ia cosi 1A sin i Acos i cos icos i sinsin i0cos i0di1(式 3.3)(4)根据A矩阵和T矩阵之间的关系0T70A1A22A33A44A55A66A7，建立T矩阵规定逆时针为正,顺时针为负。Ci =cos ( i )，Si=s in ()。0A1C1S1000010S1C10000d111A2

47、C2S200S2C2000010a2C2a2S2012A3C3S300C3S300asCsa3S3003A4C4Su000010S4C40000d414人C5S5000010S5C50000015A6C6S600S6C600001000d61C30C3a3C 3nx10x1ax1px1* S30S3asSsny10y1ay1py10100nz10z1az1pz1000000010001000T1%1*“2*么3C1S1S1C1C2S2diS2C2a 2C 2a2S2nxiny1=C1C2C3-C1S2 S3=S1C2C3-S1S2 S3 nz1 = -S2C3-C2 S30x1 =S1-C10

48、z1 =0ax1 = -C1C2 s3-c1 S2C3ay1=-S1C2 S3-S1S2C3az1=S2 S3 -C2C3Px1=a3S1C2C3 - a3 S1S2 S3 + a2 S1C2=a3C1C2C3 -a3C1S2 S3 + a2C1C2Py1Pz1 =-a3S2C3- a3C2 S3 + d 1 - a2 S2C 40S40C 50S505S40C 40S50C 505A6*010d 4010000010001C6S600nx20x2ax 2px2S6C600ny20y2ay 2py2001d6nz20z2az2Pz200010001T23A4*4A5*nx2 = c4c5c6

49、- s4 s6 ny2 = s4c5c6 + c4 s6nz2 = s5c6 ox2 = -c4c5 s6 + s4c6 oy2= -s4c5 s6 + c4c6 oz2 = -s5 s6 ax2 = -c4 s5 ay2 = -s4 s5az2 = -c5 px2 = -d6c4 s5 py2 = -d6 s4 s5 pz2 = d4 + d6c5nx1ox1ax1px1nx2ox2ax2px2nxoxaxpxny1oy1ay1py1*ny2oy2ay2py2nyoyaypynz1oz1az1pz1nz2oz2az2pz2nzozazpz000100010001T T1*T23.2 机器人运

50、动学分析3.2.1 机器人运动学原理机器人运动学只涉及到物体的运动规律，不考虑产生运动的力和力矩。机 器人正运动学所研究的内容是：给定机器人各关节的角度或位移，求解计算机 器人末端执行器相对于参考坐标系的位置和姿态问题。各连杆变换矩阵相乘，可得到机器人末端执行器的位姿方程（运动学方程） 为：nxOxaxPxnyOyaypynzOzazPz00010T7 0A*1A2*2A3*3A4*4A*5A6*6A7（式 3.4 ）其中：Z向矢量处于手爪入物体的方向上，称之为接近矢量a ,y向矢量的 方向从一个指尖指向另一个指尖，处于规定手爪方向上，称为方向矢量0 ;最后一个矢量叫法线矢量n，它与矢量0和矢

51、量a 一起构成一个右手矢量集合， 并由矢量的叉乘所规定：n= o*a。机器人变换矩阵p，它描述了末端连杆坐标系7相对基坐标系0的位姿, 是机械手运动分析和综合的基础。表3.2 G300型串联机器人 D-H参数表连杆编号/弧度a/毫米/弧度d/毫米偏移1/20112002/202003/203140.84/271.840/251271.8506/2060/27007129.60下限348788348788788848348上限3748330837483308330832483748表3.3 G300型串联机器人驱动空间参数(关节1-7换算关系1=0.088度)2速度范围(1-1023),换算关系1=0.114转/分钟最大加速度：2180度/秒3.2.2机器人运动学步骤1、根据机器人D-H参数得到传递矩阵AK(k=0,1,2,3,4,5,6,7)，相乘后得到T矩阵，根据一一对应的关系，写出机器人正解的运算公式，并填入下表中表3.4机器人运算公式参数计算公式nxnx =(C1C2C3 -C1S2S3 )* (C 4C