沈阳工业大学硕士学位论文摘要机器人学的一个最终目标是能制造出自治型机器人,如果将机器人看作是一种能够 扩展人类工作能力的有效工具,那么人类在认识和改造世界的过程中就不能没有机器人。工业机器人是机器人家族中的一个重要分支,是机器人领域的重要研究发展方向。因此,对工业机器人运动路径规划的研究,一直受到人们的普遍关注。基于最少时间、最少能量和避障等的不同目标,许多研究学者对路径规划问题进行 了探索。本文针对近年来在工业机器人路径规划的热点问题一机器人作业中避障的快速性与路径的最优性一进行了系统而深入的研究。前者由于机器人构型空间的复杂性与机器人作业的快速性要求,而使路径规划问题具有极大的挑战性;后者则因为机器人作业的精确性要求,所以从此角度对路径的最优性进行了探索与研究。本文主要研究如下几个问题:1 .针对6自由度的工业机器人,建立了工业机器人的运动学模型。本文中,建立了两类工业机器人的运动模型:其一为ABB IRB1400型工业机器人:另一为RK1 0S型工业机器人,这两类机器人皆是典型的SCARA型工业机器人。2.为避免繁琐的机器人示教过程,从避障快速性的角度出发,提出了离线的基于 波扩散方法的工业机器人路径规划算法。首先对机器人的工作空间离散化,针 对工作空间中的障碍点和自由点进行二值标记;然后用波扩散方法对自由点进 一步标记,并进行了路径搜索;最后,以波扩散法与深度优先算法路径搜索进 行了比较。针对6一自由度的工业机器人验证所提出的算法,得到了满意的效 果。以ABB IRB 1400型6-DOF工业机器人作为仿真对象,用SGI工作站,在ENVI SION仿真环境下进行仿真。从仿真结果看,所研究算法在机器人路径规划方面是可行的。 3.针对机器人作业中的精确性的要求,本文基于孤岛搜索策略,提出了在机器人 的构型空间中采用遗传算法进行路径规划找出最优路径的方法。以RK1 0S型6-DOF工业机器人作为仿真对象,用SGI工作站,在ENVI SION仿真环境下进行沈阳工业大学硕士学位论文仿真。从理论分析和仿真实验结果的一致性,证明了算法的有效性和合理性,因而该方法在路径规划方面是可行的。本课题得到国家自然科学基金(课题号:69975020)的资助关键词:工业机器人,路径规划,波扩散方法,深度优先算法,孤岛搜索策略,遗传算法 沈阳工业大学硕士学位论文Path-planning Algorithm Research of Industrial RobotsAbstractOne of the ultimate goals in Robotics is to create autonomous orbots. Since orbot can bevi ewed saa n efective extension of human's motor ability, it is suert o be indispensable in thecourse of ercognition and exploration of the world. Due to its important orle in theorya nd appli-cation, the motion planning of industrilaor bot has been given enough attention勿researchersi n the world. Many ersearchers have been investigated on the path planning for various objectives suchas minimum time, minimum energy, and obstacle avoidance. Two main problems have beenstudied on the path planning of industrilaro bot in ercent years. One problem is the obstacleavoidance speediness of the orbot during it's working; the other problem is how to guaranteethe optimization of the path we searched. Owing to the complexity of the configuration spaceand the speediness of the orbot's working demand, the former has huge challenge for the pathplanning of the robot; the later has much dificulty for theera erl ots of limits erlating to thetime used to search the optimizing path. The main ersults as the following:1 . Build the motion model according to the 6 DOF industrilaor bots. One is the motionmodel of the ABB IRB1400 industrilaor bot whose joints aeral l ortating; the other is the modelof the RK l OS industrila orbot which is similar to the ABB IRB 1400 industrilar obot.2. Instead of using the tedious process of robot teaching, an off-line path planning lago-rithm based on wave expansion method has been developed for industrilaor bots. The conti-nuous Cartesian W-space in world coordinates is discertized into an equidistant 3D-grid andthen the fere points and obstacle points are indicated by diferent numbers. By use of the waveexpansion method, the free points aerf urther assinged marked number. The path is ifnded basedon the assinged marked number via wave expansion method. As comparison, depth-ifrst searchmethod is presented. The proposed lagorithm is tested on a ABB IRB1400 6-DOF industrilaorbot under ENVISION circumstance and the expected ersults areo btained. 3. Based on island-driven search strategy, genetic lagorithm is present to plan path inorbot's configuration space in demand of the robot's work. The proposed lagorithm is tested on・3・沈阳工业大学硕士学位论文aRK10S6一DOFind比侧alrobet四derENVISI《〕NC】rCUn节t日n伴.Theefecfivenestsand丫allidyotf面saPProachaePrroved衍山eoretialacnalsiysands加u】成lonresulst.K叮word引Indsu州aiorob屯pahpltnnaing,eevawxaPsninmeohtod,dePth币rstserachmet hdo,ilsand.d对venseerahsOate罗,geneticalgorihtm一4・独创性说明 本人郑重声明:所呈交的论文是我个人在导师指导下进行的研究工作及取得的研究成果。尽我所知,除了文中特别加以标注和致谢的地方外,论文中不包含其他人已经发表或撰写的研究成果,也不包含为获得沈阳工业大学或其他教育机构的学位或证书所使用过的材料。与我一同工作的同志对本研究所做的任何贡献均已在论文中做了明确的说明并表示了谢意。签名:里卫土丝红日期:夕沪夺,名关于论文使用授权的说明本人完全了解沈阳工业大学有关保留、学校有权保留送交论文的复印件,使用学位论文的规定,即:允许论文被查阅和借阅;学校可以公布论文的全部或部分内容,可以采用影印、缩印或其他复制手段保存论文。(保密的论文在解密后应遵循此规定)签名:3ij也式导师签名:命冷形日期?.o沈阳工业大学硕士学位论文1绪论路径规划是机器人导航中最重要的任务之一。机器人的路径规划问题可以分为两大 类:一类是基于环境先验信息的全局路径规划;另一类是基于不确定环境的传感器信息的局部路径规划。本文的主要工作是对路径规划算法进行理论的研究,解决工业机器人全局路径规划问题。1.1机器人技术的发展历程与定义机器人的诞生,无疑是20世纪人类科学技术的重大成就。近40年的时间,机器人 从无到有,在世界经济各个领域和人民生活的众多方面忠诚的为人类服务,作出不可磨灭的贡献。在工业机器力发展及应用日益广泛的今天,机器人已被人们看作是一种生产工具,在制造、装配及服务行业,机器人的应用取得了明显的进步。世界上第一台工业机器人是在20世纪60年代初诞生的。此后,工业机器人应用于 汽车制造业取得成功,并被广泛应用于其他制造行业。这一时期的机器人被称为顺序控制机器人,由预先编制好的程序控制运行,缺少感知自身和环境状态的能力,所以只能运行于固定环境中,缺乏对环境的适应性。为了让机器人有一定的感知能力,人们给机器人装上了许多不同功能的传感器,形 成了具有传感器信息反馈的第二代机器人。借助于传感器,机器人能通过“视觉”、“触觉”等传感器对外部环境进行实际探测,从而由这些反馈信息在事先编好的算法和 程序指导下对操作过程进行调整。与第一代机器人相比,第二代机器人更加具有柔性和安全性。然而,该类机器人的自身状态和环境状态信息是非数值化的,人们希望机器人能像人类一样自主接受和解释这些非数值信息,由此开始了第三代机器人,即智能机器人的研制.目前,由于机器人在国民经济及人们生活中有极大的应用潜力,世界各国的机器人 的研究都极为重视,但各国对机器人的定义却各有差异,且有一定的局限性和不够确切之处。如英国机器人协会田RA)的定义是:“一种可以重复编程的装置,用以加工和搬运零件、工具、特殊的加工器具,通过可变的程序流程以完成特定的加工任务。”美国国家标准局(NBS)的定义是:“一种可编程的自动控制下完成某些加工任务或动作的机沈阳工业大学硕士学位论文械装置。”最近联合国标准化组织定义为:“一种可重复编程的多功能操作手,用以搬运材料、零件、工具或者是一种为了完成不同操作任务,可以有多种程序流程的专门系统。”分析以上的各种定义,可以发现大部分是针对工业机器人而言的。由此可见,工业机器人在机器人领域的地位极其重要,有待进一步研究。1.2本课题的研究意义及国内夕!研究动态未来的机器人应该具有感知、规划和控制等高层能力。它们能从周围的环境中收集 知识,构造一个关于环境的符号化的世界模型,并使用这些模型来规划、执行由应用者下达的高层任务,其目标是实现机器人的使用者在较高的层次给机器人下达一些较宏观的任务,由机器人系统自身来填充那些较底层的细节问题。因此,机器人的路径规划是规划模块中的一个重要组成部分。在机器人领域,目前国内外研究机构正在研究的内容有以下几个方面: 开展对未知环境下机器人导航问题的研究。在未知环境下自主导航的重要问题是对 环境的感知。Bosotn大学利用立体视觉及超声距离传感器实现了对物理世界的标图。Ohio州立大学采用不同的机器,以协调的方式来进行绘制地图等。Calfon五a大学等利用Kohonne神经网络来表示机器人工作环境的自由空间,其方法比较独特。更普遍采用的方法是用栅格法来表示未知环境。未知环境下的自主导航,对机器人的避碰能力提出了更高的要求,国外在这方面的 研究中一个明显的趋向是采用势场法、模糊控制、神经网络、遗传算法等综合技术手段来达到目的,尤其是在不同程度上采用神经网络、遗传算法的方法是当前研究的重点。在未知环境逐步被探测的基础上,全局路径规划依然是自主导航中的一项关键技 术。国内外对路径规划技术的研究己有很多成果,值得指出的是Clsauis与Miilso等学者效仿神经网络技术提出的一些并行规划方法,思想较新颖,在相应的硬件支持下,将会在规划程度上有较大提高。智能机器人体系结构的研究依然是机器人领域的一个受人关注的课题。随着对智能 和实现智能途径的看法不同,产生了不同的体系结构。比较典型的是基于功能模块划分的分层递阶体系结构和面向行为划分的包容体系结构。从智能的手段上,基于联结主义的人工神经网络技术也在某些方面取得很大的成功,所以在传统的人工智能研究的方沈阳工业大学硕士学位论文法基础上,如何与人工神经网络技术相结合也成为国内外学者在体系结构研究中探索的 方向。 1 .3机器人路径规划研究的研究综述路径规划技术是机器人研究领域中的一个重要分支。机器人路径规划的基本问题是 在空间中确定自初始点至目标点的一条无碰撞的运动路径,即无碰撞路径规划1 ]1。蒋新松为路径规划作出了这样的定义:路径规划的任务就是在具有障碍物的环境内按照一定 的评价标准,寻找一条从起始状态(包括位置和姿态)到达目标状态(包括位置和姿 态)的无碰撞路径。障碍物在环境中的不同分布情况当然直接影响到规划的路径,而目 标位置的确定则是由更高一级的任务分解模块提供的。 根据对环境的了解情况,路径规划可以分为全局规划和局部规划。其中,全局规 划需要知道关于环境的所有消息;而局部路径规划则只需要距离机器人较近的障碍物信息。如果从静态或动态地获取障碍物信息角度看,全局路径规划属于静态规划,而局部路径规划则是动态规划。一般的路径规划算法都会涉及到以下几个问题:位姿空间、环境表示、规划方法 和搜索方法等问题。1.3.1位姿空间(Con五即以1佣SpaeC)一个物体或机器人的位姿是指能完全地确定该物体或机器人上所有点的一个相互独 立的参数集,不仅描述了运动的位置,而且考虑了它的姿态。一个由物体的所有位姿所组成的位姿空间则代表了该物体的所有可能的运动,成为路径规划领域中的一个基本问题。由于障碍物的存在,运动物体在该空间中就有一个相应的禁区,称为“位姿空间障碍域”,运动物体与障碍物发生碰撞的所有状况都属于这个域。这实际上是把运动物体、障碍物及其几何约束关系作了等效的变换,简化了问题的解决.位姿空间最初是由LO乙川0一Perez和wesely提出来的IjZ,它将路径规划问题转变为位姿空间中的起始位姿和终止位姿之间找到一个连续的位姿节点序列。通常说来,位姿空间的维数是机器人的自由度数DoF(e孚eDeof斤以刘om)。沈阳工业大学硕士学位论文1. 3.2环境表示法对机器人活动空间的有效描述称为环境模型。机器人在规划前首先要做的就是将环 境的描述有外部的原始形式通过一系列处理转化为适合规划的内部的世界模型,这个过 程称为环境建模,其中主要的是障碍物的表示方法。合理的环境表示才能有利于规划中 搜索量的减少,才能有利于时空开销的减少。不同的规划方法正是基于这种不同的环境 建模。以下是几种常用的环境表示方法:1. 3.2.1栅格表示法栅格表示法就是使用大小相同的栅格划分机器人的工作空间,并用栅格数组来表示 环境13-61。每个栅格点以两种状态之一表示,或者在自由空间中,或者在障碍物空间中。如可将障碍物在栅格数组中标为一1,自由空间标为0。路径是通过搜索栅格图得到的。为了提高搜索效率,栅格通常分为若干层次,这种方法特点是简单,易于实现,从而为路径规划器的实现带来了很多方便,具有表示不规则障碍物的能力。其缺点是表示效率不高,存在着时空开销与求解精度之间的矛盾。1.3.2.2单元树法单元树法是为了克服栅格法的缺点而设计的。这种方法把机器人工作空间划分为几 个较大的单元【”1(一般来说,二维空间划分成4部分,称为四叉树;三维空间划分为8部分,成为八叉树)。划分得到的每个单元所占用的工作空间可能是下面三种情况之一:都为自由空间;都为障碍物空间;混合型空间,即既包含了障碍物区域,又包含了自由区域。对于最后一种类型的单元按照前面的方法继续进行划分,直到一个预先设计好的精度为止。该方法的主要缺点是计算单元之间的邻接关系时的损失较大。1.3.2.3多边形(多面体)表示法多边形(多面体)表示法也是常用的方法之一【 101['111。二维情况下,该方法用多边形来逼近障碍物;三维情况下,则用多面体来逼近障碍物.同时,使用了很多成熟了的求交叉点和测距等方面的解析几何算法。1.3.3规划方法为了解决路径规划问题,人们己探索出很多有效的求解方法。机器人路径规划方法 大致可以分为两类:传统方法和智能方法。沈阳工业大学硕士学位论文L33. 1传统路径规划方法[Jl1 卜33.1.1自由空间法为了简化问题,通常采用“位姿空间”来描述机器人及其周围的环境。这种方法将 机器人缩小成点,将其周围的障碍物及边界按比例相应地扩大,使机器人能够在障碍物空间中移动到任意一点,而不与障碍物及边界发生碰撞。 1. .33.1.2图搜索法图搜索方法中的路径图由捕捉到的存在于机器人一维网络曲线( 称为路径图)自由空间中的节点组成。建立起来的路径图可以看作是一系列的标准路径,而路径的初始状态和目标状态同路径图中的点相对应,这样路径规划问题就演变为在这些点间搜索路径的问题。通过起始点和目标点及障碍物的顶点在内的一系列点来构造可视图。连接这些点, 使某点与其周围的某可视点相连(即使相连接的两点间不存在障碍物或边界)。然后机器人沿着这些点在图中搜索最优路径。13.3.1.3栅格解拐法栅格解祸法是目前研究最广泛的路径规划方法。该方法将机器人的工作空间解祸为 多个简单的区域,一般称为栅格。由这些栅格构成了一个连通图,在这个连通图上搜索一条从起始栅格到目标栅格的路径,这条路径是用栅格的序号来表示的。栅格解祸法包括确切的和不确切的两种。确切的解祸法用来描述整个自由空间,这将使复杂环境的解祸速度变慢,其原因是 许多复杂的多边形可能需要与障碍物的边界相匹配。这种方法可以保证只要起始点到目标点之间存在路径,就完全能搜索到这条路径。在不确切的解祸法中,所有的栅格都是预定的形状,为了研究方便假设全部为矩 形。整个图被分割成多个较大的矩形,每个矩形之间都是连续的。如果大矩形内部包含障碍物或者边界,则又被分割成4个小矩形,对所有稍大的栅格都进行这种划分,然后在划分的最后界限内形成的小栅格间重复执行程序,直到达到解的界限为止。这种解祸的结构称为“四叉树”。在进行下一层更细的划分之前,应在每一层上的起点和目标点间找到一条路径,如果该路径满足起点到目标点间无障碍物的要求,则停止搜索。_——一一一逃m工业t学硕士学位论文不确切的栅格解祸方法比确切的栅格解祸方法在数学计算上要简单的多,因此也比 较容易实现。 1. 3.3.1.4人工势场法传统的人工势场法把机器人在环境中的运动视为一种在抽象的人造受力场中的运 动,目标点作为吸引点对机器人产生“引力”,而障碍物作为排斥点对机器人产生“斥 力”,机器人沿吸引点和排斥点产生的合力方向运动。该方法构造一个叫做势函数的标 量函数,使机器人的目标位姿对应于其最小值,障碍物区域对应于一些较大的值,在任 何其它位置,势函数都是向机器人目标位姿单调递减的。这样,不论机器人处于自由空 间的任何位置,只要有路径存在,它都能通过势能值的负梯度方向找到目标位姿。该方 法的优点是可以使机器人迅速避开障碍物,实时性好.但是,由于势场法把所有信息压 缩为单个合力,这样就存在把有关障碍物分布的有价值的信息抛弃的缺陷,且易陷入局 部最小值。另外一个困难是很难找到一种适合于凹形障碍物的势函数。这些不利因素限 制了人工势场法在全局路径规划中的应用。 大部分机器人路径规划中的全局规划都是基于上述几种方法进行的,但是以上这些 传统方法在路径搜索效率及路径优化方面尚有待于进一步改善。而现在通常使用的搜索技术包括:梯度法、A’等图搜索方法、枚举法、随机搜索法等。这些方法中梯度法易陷入局部最小点,图搜索方法、枚举法不能用于高维的优化问题,因此随机搜索算法受到人们的青睐。1.3.3.2智能路径规划方法近年来,随着遗传算法等智能方法的广泛应用,机器人路径规划方法也有了长足的 进展,许多研究者把目光放在了基于智能方法的路径规划研究上。其中,应用较多的算法主要有:模糊方法、神经网络和遗传算法。1.3.3.2.1基于模糊逻辑的机器人路径规划模糊方法是在线规划中常采用的一种规划方法,包括建模和局部规划。庄晓东等[ I21提出一种基于模糊概念的动态环境模型,参照物体的位置和运动信息构造二维隶属度函数;然后通过模糊综合评价对各个方向进行综合考察,得到搜索结果。该方法在移动障碍物和移动目标的环境中能有效地实现机器人避碰和导航。Hartmllt Surinam等[I3]提出沈阳工业大学硕士学位论文了一种未知环境下的高级机器人模糊导航方法,由5个不同的超声传感器来提供环境信 息,然后利用基于模糊控制的导航器来计算这些信息,规划机器人路径。 该方法在环境未知或发生变化的情况下,能够快速而准确地规划机器人路径,对于 要求有较少路径规划时间的机器人是一种很好的导航方法。但是,其缺点是当障碍物数 目增加时,该方法的计算量会很大。影响规划结果。 13. 322基于神经网络方法的机器人路径规划禹建丽等州魄出了一种基于神经网络的机器人路径规划算法,研究了障碍物形状和 位置已知情况下的机器人路径规划算法,其能量函数的定义利用了神经网络结构,根据 路径点位于障碍物内外的不同位置选取不同的动态运动方程,规划出的路径达到了折线 形的最短无碰撞路径,计算简单,收敛速度快。陈宗海等1 151提出一种在不确定环境中移动机器人的路径规划方法,将全局路径规划分解为局部路径规划的组合,为了提高规划的效率,在避障规划中采用了基于案例的学习方法,以ARI、2神经网络实现案例的匹配学习和扩充,满足了规划的实时性要求。13.32.3基干遗传算法的机器人路径规划遗传算法是目前机器人路径规划研究中应用较多的一种方法,无论是单机器人静态 工作空间,还是多机器人动态工作空间,遗传算法及其派生算法都取得了良好的路径规划结果。孙树栋等1 116用遗传算法完成了离散空间下机器人的路径规划,并获得了较好的仿真结果。但是,该路径规划是基于确定环境模型的,即工作空间中的障碍物位置是已知的、确定的。K斑见OS u乡braa等1711在采用离散空间进行路径规划的同时,将问题更深入化,栅格序号采用二进制编码,统一确定其个体长度,随机产生障碍物位置及数目,并在搜索到最优路径后,再在环境空间中随机插入障碍物,模拟环境变化,通过仿真结果验证了算法的有效性和可行性。但是,规划空间栅格法建模还存在缺陷,即若栅格划分过粗,则规划精度较低;若栅格划分太细,则数据量又会太大。在多移动机器人协调作业方面,遗传算法也得到了应用,景兴建等,愧出一种基于理性遗传算法的协调运动行为合成算法,针对特定环境下的多机器人协调运动问题,基沈阳工业大学硕士学位论文于调速避碰的思想,借助CMAC神经网络,描述各机器人的运动行为与环境状态之间复杂的、非线性映射关系,利用理性遗传算法来合成与优化各机器人的运动行为,从而实现多机器人已知环境下,运动行为的相互协调与优化。1.3.3.2.4基于混合方法的机器人路径规划方法Ts oukalas LH等[19]提出一种用于半自主移动机器人路径规划的模糊神经网络方法。所谓半自主移动机器人就是具有在人类示教基础上,增加了学习功能的器件的机器人。这种方法采用模糊描述来完成机器人行为编码,同时重复使用神经网络自适应技术。由机器人上的传感器提供局部的环境输入,由内部模糊神经网绍进行环境预测,进而可以在未知环境下规划机器人路径。综上所述,遗传算法等智能方. 法在机器人路径规划技术中已受到广泛的重视及研究,在障碍物环境己知或未知情况下,均己取得一定的研究成果。1.3.4搜索方法给定一种机器人工作空间的表示方法和标识自由位姿空间的能力后,路径规划问题 就转变为从给定的表示中找到一个从起始位姿到终止位姿的连续的位姿序列的问题了。大体说来,搜索技术可分为以下三类:1.3.4.1基于微积分的搜索技术该技术使用由优化问题的解来满足的一组充分必要条件。这些技术一般只能用于解 较简单的问题。用Hopfield神经网络方法求解优化问题是这类技术的一个实例。1.3.4.2有指导的随机搜索技术该技术以枚举技术为基础,但附加了一些指导搜索过程的信息。它们的应用范围很 广,并能解决十分复杂的问题,其两个主要的构成部分是模拟退火算法。它们本身都是进化,但前者使用热力学模型的演化过程来寻找最低能量状态。而进化算法则是以自然选择过程为指导。遗传算法(Geneitc Algorithm)为特例之一。从上世纪90年代以来,用有指导的随机搜索技术,尤其是遗传算法进行路径规划是国内外学者进行研究的重点。1.3.4.3枚举技术该技术是搜索目标函数的域空间的每一个节点,它们的实现简单,但可能会需要很 大的计算量。动态规划是其中一种很好的方法。路径规划技术中常用的深度优先搜索、沈阳工业大学硕士学位论文广度优先搜索、A* 搜索都是其特例。机器人路径规划是机器人应用中的一项重要技术,例如,在执行装配、焊接及抢险 救灾等任务时,采用良好的机器人路径规划技术可以节省大量机器人作业时间、减少机 器人磨损,同时也可以节约人力资源,减小资金投入,为机器人在多种行业中的应用奠定良好的基础。将遗传算法、模糊逻辑以及神经网络等方法相结合,可以组成新的智能 型路径规划方法,从而提高机器人路径规划的避障精度,加快规划速度,满足实际应用 的需要。同时,多机器人协调作业环境下的路径规划技术也将是研究的热点及难点问 题,越来越受到人们的重视,这将是一个有意义的研究课题。1.4本文的主要工作本文对机器人的路径规划进行了较为系统的研究。在对大量相关文献进行深入分析 的基础上,在对机器人路径规划算法理论研究和实践过程中,提出了不同的机器人路径规划算法和思想。l( )针对6自由度的工业机器人,建立了工业机器人的运动学模型。本文中,建立了两类工业机器人的运动模型:其一为ABB」RB1400型工业机器入;另一为RK卫5型0工业机器人。)针对机器人避障快速性的要求,提出了的基于波扩散方法的工业机器人路径规2( 划算法・对6・自由度的工业机器人仿真验证所提出的算法,得到了满意的效果・以ABBIRB10O型6一4DOF工业机器人作为仿真对象,用SGI工作站,在ENV】S10N仿真环境下进行仿真。从仿真结果看,所研究算法在机器人路径规划方面是可行的。3( )针对机器人作业中的精确性的要求,基于孤岛搜索策略,提出了在机器人的构型空间中采用遗传算法进行路径规划找出最优路径的方法。以RK1s型6一0DoF工业机器人作为仿真对象,用SGI工作站,在ENVIIsON仿真环境下进行仿真。从理论分析和仿真实验结果的一致性,证明了算法的有效性和合理性,因而该方法在路径规划方面是可行的。沈阳工业大学硕士学位论文2工业机器人的运动学模型典型SCARA型工业机器人是关节机器人,6个关节都是转动关节。因此,可以把 任何机器人的机械手看作是一系列由关节连接起来的连杆构成的。2.1 RK10S型工业机器人RKI OS机器人是典型的SCARA型工业机器人,6个关节都是转动关节。前3个关节确定手腕参考点的位置,后3个关节确定手腕的方位。后3个关节轴线交于一点,该点选作为手腕的参考点。关节1的轴线为铅直方向,关节2和3的轴线水平,且平行。关节1和2的轴线垂直相交,关节3和4的轴线垂直交错。2.1, I机器人坐标系的建立为机械手的每一连杆建立一个坐标系,并用齐次变换来描述这些坐标系间的相对位 置和姿态。选RK10S机器人的基坐标系作为参考坐标系,即为该机器人关节0的坐标系。其他关节的坐标系,以基坐标系为基准,通过平移和旋转而得到。如图2.1为机器人连杆坐标系图,其中,d,-d5为机器人连杆参数,01--66为关节转动的角度及其方向,箭头所指方向定义为转动正方向。06跳,-----d-,------图2.1 RK10S型机器人坐标系的建立沈阳工业大学硕士学位论文2.1.2机器人连杆参数要对机器人进行规划与控制,必须对其连杆参数清楚了解。表2. 1列出了机器人的连杆参数。表2. 1 RK108机器人的连杆参数连杆i变量0id(t-n)变量范围101200-170’-170202600-150一90303115-70 -90404770-180 -1805e5100-135‘-135606-200' -2002.1.3通常把描述一个连杆与下一个连杆间相对关系的齐次变换叫做A矩阵。一个A矩 阵就是一个描述连杆坐标系间相对平移和旋转的齐次变换。如果A,表示第一个连杆对于基系的位置和姿态,A2表示第二个连杆相对于第一个连杆的位置与姿态,那么第二个连杆在基系中的位置和姿态可由下列矩阵的乘积给出。爪=A,A,同理,对于六连杆机械手,有下列T矩阵OT6=A,AZA3A,A,A6(2.1)根据机械手各连杆之间的关系及其连杆参数,可求得各连杆变换矩阵如下:姆一SO,0D7,二A,=Ror(Z, e, ) -Trans(y, a, ) 喊CB,111 一 ̄ 00 ,.二(2.2) 00 卜U 自伙0 0 ,几=!12=Rot(x,么)-Trans(z,鸽) 四 一一 .旧C02一s02 |S久CO,(2.3) 旧 」0 0 沈阳工业大学硕士学位论文2.2 ABB IRB1400型工业机器人本文中建立的另一个机器人模型为ABB IRB 1400型工业机器人,其结构与RK10S型机器人类似。因此,只对其简单介绍。2.2.1机器人连杆参数下表为机器人连杆参数: 连杆i12表2. 2机器人的连杆参数变量0i0l02a-1(nim)018895022500di(-)9000变量范围-180' -180'-70'刀0'-30' -135'-300'-300*-120'--120'-300' -300'3456e304e5e601300002.2.2机器人运动学模型机械手的T变换矩阵形式与式( (2.8)同,其具体元素如下:n, =C IIC23(C4CSC。一S4S6)一S23S5C65 + SI(S4C5C6 + C4S6)ny=SlIC23(C4C5C‘一S4S6)一S23S5C6]一Cl (S4C5C6 + C4S6)n,=-S23(c4c,c‘一S4S6)一C23S5C60}=CI I-C23 (C4C5S6 +S4C6) +S23S5S6]一Sl(S4c5c。一C4C6)Oy = SI[-C23(C4C5S6 +S4C6) + S23S5S6]+ CI(S4C5S‘一C4C6)0z =S 23(C4CSS6 + S4C6) + C23S5S6a.=-CI (C23C4S5 + S23C5)一SIS4S5ay= -SI(C23C4S5 + S23C5) + cls4S5a,=S23C4S5一C23C5(2.10)Px = Cl (a3c二一d4S23 +a2C2 +a,)Py=SI(a3C二一d4S23 +a2C2 +a,) P} = -a3S23一d4C23-a2S2 +d, J2.2.3机器人运动学综合由于本文所提出的波扩散方法的实现中,要用到机器人的逆运动学的解。用到的 一14-沈阳工业大学硕士学位论文3基于波扩散方法的工业机器人路径规划3.1引言2 0世纪80年代初,Lozan-oPeerz提出了构形空间((Conifguraiton Space)的概念[201机器人的一种位姿状态可以用构形空间上的一个点—构WConfiguraiton)来描述。与此相对应,一些研究者将人类生存的三维空间称作世界空间(WorldSpace)2[Q。关于关节式机器人路径规划的研究多数是使用完整的构形空间信息的精确规划方法[22-251。但是,由于关节式机器人构造的特点,这种方法存在下面的问题:1 )具有旋转关节时,自由构形空间的计算比较复杂。2 )基于完整信息的规划法通常计算量随机器人自由度的增加而呈指数增加,多自由度的情况下有可能无法计算。为了克服上述问题,直接使用世界空间(又称为笛卡儿空间)的信息,而且只使用 机器人周围的信息的启发式规划法引起了研究者们的注意.这种规划方法回避了自由构形空间显式描述的复杂计算。基于机器人周围信息的规划法只考虑与当前机器人运动关系最密切的机器人周围的信息,基于某种启发式的规则探索路径。基于有效的启发式规则的探索可以大大地缩短计算时间。当然,在不幸的情况下这种方法有可能比精确方法还要慢,甚至导致探索失败而找不到结果。考虑到实际的关节式机器人(特别是工业机器人)的作业环境通常不会过分复杂狭窄,可以认为研究能够适用于一般环境(例如对于人类规划者不会感到非常复杂)的启发式规划法是一种实用的方向。近年来,在工业机器人研究领域,基于C一 空间法许多学者作了大量的工作。对于3-DOF的工业机器人,路径规划研究方法已经成熟[261. [271. Hwang等人所提出的机器人路径规划是也只是面向3-DOF的机器人[281。然而,随自由度的增加,C一空间呈指数型增长。因此,基于离散化C一空间表示的路径规划方法对于3-DOF以上的机器人并不适用。对于多自由度机器人,Barraquand和Latombe提出了分散表示方法[291,其缺点是常陷入势场函数的局部极小点中。D.zhu和J. Latombe提出了用启发式函数的方法,但该方法不能保证找到路径PO]. Y.Ting等人也是基于C一空间方法提出工业机器人的路径沈阳工业大学硕士学位论文规划算法[I3I,该算法是先把机器人的工作空间离散化为3个二维的距离图,然后将其ZJ映射到机器人的C一空间,用深度优先算法规划出机器人运动路径。针对一般机器人路径规划采用关节坐标,本文提出了一种基于工业机器人的笛卡尔 工作空间的路径规划算法,从理论上简化了路径规划方法。首先,对机器人的工作空间进行离散化,用波扩散法对离散点进行标记,然后进行搜索找出合适路径。并使用该方法与深度优先算法进行了比较,从路径搜索效率来看,波扩散法能在较短时间内找到合适路径,因而优于深度优先算法。最后,以ABB】RB1400型吞DOF工业机器人作为仿真对象,在ENVlls0N仿真环境下进行仿真。从仿真结果看,所研究算法在避障和机器人路径规划方面是可行的。3.21作空间离散化假定以w表示机器人的工作空间,B i(1月,…,)r表示工作空间中的r个障碍物,因而可知U‘1一Ii为障碍空间,则机器人自由空间w触定义为:BW脉=W・Ur 。一IBi径。(3.1)机器人路径规划就是在W五“中绕过障碍物搜索一条自起始点到目标点的无碰撞路工作空间离散化具体方法为:世界空间坐标系下,将x,y,2轴的工作空间中 的区域段等分(定义等分长度为单位距离),因此整个空间离散化为若干等分,将离散的交叉点为作为研究对象.定义障碍空间ur:iIi中的点为障碍点,而自由空间BW阮。中的点为自由点。对工作空间中的离散点进行二值化,即对障碍点和自由点分别标记以不同数字(如:障碍点可标记为一1,而自由点标记为0),依此来区分工作空间中的障碍点和自由点。工作空间离散化的目的是把连续的世界空间离散化为等距的栅格,便于路径的搜索。.波扩散法(3W淤eePx田”lnmeohtd)路径搜索o.331波扩散算法工作空间离散化后,对离散点进行二值化以区别障碍点和自由点。为进行路径 搜索,需对自由点进一步标记,此标记说明了离散点距初始点的远近。所以,用波扩散法标记工作空间中的自由点并搜索路径。波扩散算法步骤如下:沈阳工业大学硕士学位论文4基于遗传算法(Geneitc Algorithm)的工业机器人路径规划为解决机器人路径规划中的全局最优问题,并针对机器人作业中的精确性的要求, 本文基于孤岛搜索策略,提出了在机器人的构型空间中采用遗传算法进行路径规划找出最优路径的方法。在构型空间((Configuration Space)中,可以采用如下的一种算法:将路径考虑成一系列的路径点,用人工势场法进行规划,用网络结构并行实现。在实时性方面,此算法具有很大的优势。然而,此算法对于全局最优解的寻找却为力[[35,1[361因此,引入遗传算法来帮助寻找全局的最优解。在机器人的作业过程中,有时需要其所走过的路径精度较高,即路径趋于全局最优,此时便可以用本章所提出的基于遗传算法的路径规划方法。近年来,随着遗传算法等智能方法的广泛应用,许多研究者把目光放在了基于智能 方法的路径规划研究上[37,4514.1引言遗传算傲GA) 是一种新发展起来的优化算法,它产生于美国的密执根大学。从上世纪60年代起,密执根大学的Hollsiten, Bagley和Rosenberg等人的博士论文即与遗传算法密切相关,而John H. Holland教授1975年出版的“Adaptaiton in Natural andArtiifcial Systems" [461一书通常认为是遗传算法的经典之作,因为该书给出了遗传算法的基本定理,并给出了大量的数学理论证明。David E. Goldberg教授1989年出版的"Ge netic Algorithm”一书通常认为是对遗传算法的方法、理论及应用的全面系统的总结。遗传算法已经成为人们用来解决高度复杂问题的一个新思路和新方法。目前遗传算法已被广泛应用于许多实际问题,如函数优化、自动控制、图象识别、机器学习、人工神经网络、分子生物学、优化调度等许多领域中的问题[47-491,遗传算法是基于自然选择和基因遗传学原理的搜索算法。它将“适者生存”这 一基本的达尔文进化理论引入串结构,并且在串之间进行有组织但又随机的信息交换。伴随着算法的进行,优良的品质被逐渐保留并加以组合,从而不断产生出更佳的个体。这一过程就如生物进化那样,好的特征被不断地继承下来,坏的特性被逐渐淘汰。新一代个体中包含着上一代个体的大量信息,新一代的个体不断在总体特沈阳工业大学硕士学位论文性上胜过旧的一代,从而使整个群体向前进化发展。对于遗传算法,也就是不断地接近于最优解。研究遗传算法的目的主要有两个:一是通过它的研究进一步解释自然界的适应过程;二是为了将自然生物系统的重要机理运用到人工系统的设计中。遗传算法一般经过这样几个过程:首先,随机产生一定数目的初始染色体,这 些随机产生的染色体组成一个种群。种群中染色体的数目称为种群的大小或种群规模。然后,用评价函数来评价每一个染色体的优劣,即染色体对环境的适应程度(称为适应度),用来作为以后遗传操作的依据。接着,进行选择过程,选择过程 的目的是为了从当前种群中选出优良的染色体,使它们成为新一代的染色体。判断染色体优良与否的准则就是各自的适应度,即染色体的适应度越高,其被选择的机会就越多。通过选择过程,产生一个新的种群.对这个新的种群进行交叉操作,交叉操作是遗传算法中主要的遗传操作之一。接着进行变异操作,变异操作的目的是挖掘种群中个体的多样性,克服有可能陷入局部解的弊病。这样,经过上述运算产生的染色体称为后代。然后,对新的种群(即后代)重复进行选择、交叉和变异操作,经过给定次数的迭代处理以后,把最好的染色体作为优化问题的最优解..42遗传算法的优点遗传算法的中心问题是鲁棒性伽bu smes)S,所谓鲁棒性是指能在许多不同的环境中通过效率及功能之间的协调平衡以求生存的能力。遗传算法吸取了自然生物系统“适者生存”的进化原理,从而使它能够提供一个在复杂空间中进行鲁棒搜索的方法,它对于搜索空间基本上不需要什么性的假设(如连续、导数存在及单峰等)。42.1寻优方法的分类及其特点常规的寻优方法主要有三种类型:解析法、枚举法和随机法。 .42.1,1解析法解析法寻优通常可分为间接法和直接法。间接法是通过让目标函数的梯度为零,进 而求解一组非线性方程来寻求局部极值。直接法是按照梯度信息按最陡的方向逐次运动来寻求局部极值。上述两种方法的主要缺点是:一是它们只能寻找局部极值而非全局的极值;二是它们要求目标函数是连续光滑的,并且需要导数信息。这两个缺点,使得解析寻优方法的鲁棒性能较差。沈阳工业大学硕士学位论文.421.2枚举法枚举法可以克服解析法的两个缺点,即它可以寻找到全局的极值,而且也不需 要目标函数是连续光滑的。它的最大缺点是计算效率太低,对于一个实际问题,常常由于太大的搜索空间而不可能将所有的情况都搜索到,它对于中等规模和适度复杂性的问题,也常常为力。.421.3随机法鉴于上述两种寻优方法有严重缺陷,随机搜索算法受到人们的青睐。随机搜索 通过在搜索空间中随机地漫游并随时记录下所取得的最好结果。出于效率的考虑,搜索到一定程度便终止。然而,所得结果一般尚不是最优值。本质上,随机搜索仍然是一种枚举法。42.2迪传算法的优点遗传算法用到了随机技术,但它不同于上述的随机搜索。它通过对参数空间编 码并随机选择作为工具来引导搜索过程向着更高效的方向发展。因此,随机地搜索并不一定意味着一种无序的搜索。总的说来,遗传算法比其它寻优算法的优点是鲁棒性能比较好,可归纳为如下 几点:( )1遗传算法是对参数的编码进行操作,而不是对参数的本身;2( )遗传算法是从许多初始点开始并行操作,可有效的防止搜索过程收敛于局部最优解,而且有较大的可能求的全部最优解;3( )遗传算法通过目标函数来计算适配值(适应度),不需要其它的推导和附属信息,从而对问题的依赖性较小;4( )遗传算法使用概率的转变规则,而不是确定性的规则;5( )遗传算法在解空间不是盲目地穷举或完全随机测试,而是一种启发式搜索,其搜索效率往往优于其它方法:6( )遗传算法对于待寻优的函数基本无,它既不要求函数连续,更不要求可微;既可是数学解析式所表达的显函数,又可是映射矩阵甚至是神经网络等隐函数,因而应用范围较广:・29-沈阳工业大学硕士学位论文7( )遗传算法具有并行计算的特点,因而可通过大规模并行计算来提高计算速度;8( )遗传算法更适合大规模复杂问题的优化。.43遗传算法的工作原理43.1表示结构最优化问题的解有两种表示方法:二进制向量或浮点向量。使用二进制向量作 为一个染色体来表示决策变量的真实值,向量的长度依赖于要求的精度。在求解复杂优化问题时,二进制向量表示结构有时不太方便。另一种表示方法是用浮点向量,每一个染色体由一个浮点向量表示,其长度与解向 量相同。用向量x气XI,xZ,…,xn)表示最优化问题的解,其中n是维数.则相应的染色体也是V=(x;,xZ,・,幼。.432处理约束条件处理约束条件的关键在于: )a( 删除约束条件中的所有等式:( )b设计恰当的遗传操作以保证所有新产生的染色体在可行集中。为了保证染色体是可行的,必须对遗传操作过程中得到的每一个染色体进行检查。 对每个最优化问题,最好设计一个C语言子函数,其输出值1表示染色体是可行的,0表示不可行。同时,设计程序时,应当注意到一些隐含约束,即有些点虽然是可行解,但不可能是最优解。为减少程序的搜索空间,应尽可能地增加隐含条件,从而可以大大加快问题的进化过程。.43.3个体编码方法由于路径规划问题的复杂性,对于二进制串编码, 有以下缺点①若路径中途点个数较多,则编码非常长,降低了算法搜索的效率; ②采用二进制串编码, 相邻整数存在如巧和16的二进制表示分别为0111和10。,因此从15到16将改变所有的位,导致进化效率过低;③采用二进制串表示路径坐标有一定的冗余度,因此变异会产生非法个体。 一30。沈阳工业大学硕士学位论文鉴于二进制编码的以上缺点,因此采用浮点向量表示法,即用v=( xl,xZ,…,x心表示相应的染色体。为研究问题方便起见,本文只考虑机器人的前三关节,因此,用 v钊沐: ,xZ,x3)表示相应的染色体。其中,x.,撇,x3表示前三关节的关节角,皆为浮点量。 4注4遗传算法中的适应度函数(‘加ess)v()遗传算法进化过程中,必须对每个染色体进行检验,符合适应度函数要求的为可行 集中的解。适应度函数的选择在遗传算法中是相当重要的,它是引导遗传算法向问题最 优解逼近的关键因素。对于具有约束性能指标的最优问题,可以取性能指标或性能指标的变换作为适应度函数。 本文讨论的问题是求一条最短路径,约束条件是路径与障碍物不交,并且要求与障 碍物有一定的距离。由于搜索点逐渐逼近目标点,所以,可取所搜索到的点与目标点的距离作为适应度函数,即刀t sen(F)=丫(‘一x),+(,:一,),+(2:一矛伊.,)其中,、,介,、表示目标点的世界坐标;x,y,2表示搜索到的点的世界坐标。 初始种群的染色体生成后,可分别求得相应适应度函数的值。然后,按距离由小到大的顺序对染色体进行重排,为遗传操作作准备。.4.35迪传算法的操作步骤.43.5.1初始化过程初始化过程是遗传算法进化计算的起点, 其目的是找到初始种群。初始种群由一定数目(称种群大小)的个体组成。为了保证遗传算法的全局最优性,初始种群应尽可能随机分布在搜索空间中每一个区域。路径规划时,从初始点出发,在各关节变量步长范围内,随机产生种群数目为N 的染色体,即找到范围内的对应各染色体表示的点。同时,对每个点进行检验,看其是否在可行集内,即满足一定的约束条件,使机器人不与障碍物相撞。若在可行集内,则将其作为初始种群的一员;否则,重新随机生成,直到染色体种群数目达到N。具体初始化过程如下:沈阳工业大学硕士学位论文定义整数p op二sle作为染色体的个数,并且随机产生因p声ize个初始染色体。设决z策者可给出可行集的一个内点,记为VO.定义一个足够大的数M,保证遗传操作遍及整个可行集。在Rn中,随机选择一个方向d,如果Vo+Md满足不等式约束,则将v=v七十Md作为一个染色体,否则,置M为0和M之间的一个随机数,直到Vo+Md可行为止。由于VO是内点,所以在有限步内,可以找到满足不等式约束的可行解。重复以上过程pop‘,IeZ次,从而产生卯p‘5泳个初始染色体vo,vl,…,v冈cs-二。,43:5选择过程4汉5.2.1评价(选择)函数的选择选择机制在遗传算法中起着重要的作用,选择策略主要有:赌轮选择、正比选择、 标度选择、级别选择以及求和截断法等。选择机制的出发点就是以某种方式保留那些具有较好适应性的个体,淘汰适应性差的个体。最一般的方法就是赌轮选择,即对每个染色体V i,计算累积概率qi,由第三节提出的方法决定哪些染色体被选择。经过选择过程,可以复制得到N个染色体。选择过程是对样本基因的选优。其是根据个体串的适应度进行复制,以产生新的种群。适应度越大的串,在下一代中将有更多的机会提供一个或多个子孙。因此,体现了“优胜劣汰”的自然选择机制。评价函数( 用evla冈表示)用来对种群中的每个染色体v设定一个概率,以使该染色体被选择的可能性与其种群中其它染色体的适应度成比例,即通过轮盘赌,适应性强的染色体被选择产生后代的机会要大。 设目前该代中的染色体为vl,叭,…,v哪。可以根据染色体的序进行再生分配,而不是根据其实际的目标值。在染色体v:,叭,…,v娜二中,决策者可以给出一个序的关系,使染色体由好到坏进行重排,也就是说,一个染色体越好,其序号越、。设参数a‘( 0)l,给定,定义基于序的评价函数为e avl(K)二a(1一a)‘一,,1=1,2,…,尸印_sezl4(.)2月意味着染色体是最好的,厂,叩Jl ez说明是最差的。沈阳工业大学硕士学位论文4.3.5.2.2选择过程选择过程是以旋转赌轮po p size次为基础的。每次旋转都为新的种群选择一个染色体。赌轮是按每个染色体的适应度进行选择染色体的。选择过程可写成如下形式:步骤1对每个染色体V; ,计算累积概率4j9a=0(4.3)。,=艺eval(Vj ),i=1,2, *, pop_size步骤2从区间( (O,Q"_sim)中产生一个随机数:;步骤3若9j -,‘;‘4j,则选择第i个染色体Vi(I<-i-<pop size);步骤4重复步骤2和步骤3共po p SIM次,这样可以得到pop size个复制的染色体。4.3.5.3交叉操作交叉操作是对样本基因的重组,以产生更优良的后代。交叉体现了自然界中信息交 换的思想。交叉就是在复制后产生的N个个体中,以一定的概率(P})随机地进行两两配对。每对染色体根据下式((4.4)进行交叉,产生新的染色体对。本文中对选择进行交叉的染色体( 父代)随机配对,即对机器人C-空间中的两点进行处理产生新的两点,使其更优于原来的父代。首先定义参数P。 作为交叉操作的概率,这个概率说明种群中有期望值为P.. pop size个染色体来进行交叉操作。为确定交叉操作的父代,从i =1到pop size重复以下过程:从(0, 1)中产生随机数r,如果:<P},则选择V;作为一个父代.用丫.,V2, V'3r…表示选择的父代,并把它们随机分成下面的对( v',, V'Z), (V3, V'4), (V'S, V'6),以柑丫V' z)为例说明交叉操作的过程。首先,从开区间((0, 1)中产生一个随机数。,然后,按下列形式在v',和Vz之间进行交叉操作,并产生两个后代x和YX= ;C. V,+(1-c) . V2, Y=(1-c). V'i+c.V'2 (4.4)沈阳工业大学硕士学位论文检验每一个后代的可行性。如果两个后代均可行,则用它们代替其父代,否则,保 留其中可行的(如果存在的话),然后,产生新的随机数c,重新进行交叉操作,直到得到两个可行的后代或循环给定次数为止。总之,仅用可行的后代取代其父代。.4.35.4变异操作变异模拟了生物进化过程中的偶然基因突变现象。变异为新点的产生提供了机会, 保证了算法能够搜索到问题解空间的第一点,从而使算法具有全局最优,它进一步增强了遗传算法的能力。遗传算法能力主要是由选择和交叉赋予的,变异则保证了搜索的全面性。类似于交叉的父代染色体的选择过程,父代选定后,由下式(45)得出变异操作产生的新一代个体。变异操作的目的是挖掘种群中个体的多样性,克服有可能陷入局部解的弊病。因 此,用遗传算法进行路径规划可以克服传统的人工势场法的缺陷,从全局上尽可能地接近最优点。定义参数Pm作为遗传系统中的变异概率,这个概率表明,总体中有期望值为 Pm.即几sle个染色体用来进行变异操作。z类似于交叉操作中选择父代的过程,由拼1到卯n,z e重复以下过程:从区间(,0)1中产生随机数r,如果r<Pm,则选择Vi作为变异的父代。对每一个选择的父代,用v=(xl,xZ,…,叼表示,按下列方法进行变异。在Rn中随机选择变异方向d,如果v十Md是不可行的,则置M为0和M之间的随机数,直到其可行为止。其中M为初始化过程定义的一个足够大的数。如果在预先给定的迭代次数之内没有找到可行解,则置M=0。无论M为何值,总用 X=犷十M・d4(.)5代替V.如下图为遗传算法的操作流程图沈阳工业大学硕士学位论文图4.1遗传算法的操作流程4.3.6优化问题的解遗传算法程序运行过程中,最好的染色体不一定出现在最后一代中,所以在进化开 始,必须把最好的染色体保留下来,记为Vp,如果在新的种群中又发现了更好的染色体,则用它代替原来染色体Vp。在进化完成之后,这个染色体就可以看作是优化问题的解。4.4 C一空间中的障碍物检则4.4.1 RK10S机器人运动模型的简化研究机器人路径规划问题前,首先应对机器人的几何结构进行分析。典型SCARA 型工业机器人的6个关节全为转动关节,机器人的运动主要靠1至3手臂关节,其转动对机器人的姿态影响作用很大;而4至6关节为腕关节,对机器人的姿态影响不大。为研究问题方便起见,在机器人路径规划中,略去4至6关节的作用的影响,即假定后三个关节不运动((0 4=e5=06=0),只考虑前三关节的运动。在假定机器人后三关节不转动的前提下,前面所提到的运动学模型可进行简化。由 。4= 9 s=。fi},模型进一步简化为:沈阳工业大学硕士学位论文r.,.飞叭气P X. 1 0 .P 凡 才‘ 、,.巧马马y 氏 久 么 . . -- . P(56).气02az名 . I L。0o I 气=cl a二=一s1C23n夕=sl ay=clc23气=o a:=52。0 二=一5152,夕二=51(姚523一么c23+JZsZ一试)+。二“,(57)0 ,=“.s23p,=一c,(姚52,一么CZ,+丸52一试)+ay姚0:=一c2 3户:=姚c23+峨523+dZc:+az姚其中:5 1,cl,又,Q,几,几的定义与以前完全相同。这样,机器人的运动就简化为只与机器人前三关节的转角相关的运动。.442C-空间中的障碍物44.2.IC一空间中机器人的路径规划环境中具有障碍物的机器人的运动,需要以无碰撞路径规划算法为前提。否则,在 运动过程中,机器人可能与障碍物发生碰撞。而要进行路径规划,必须事先清楚以下几方面的信息:①机器人的运动学描述、几何结构及参数; ②机器人运动环境的几何模型; ③机器人的初始位置与目标位置。 以上几方面作为运动规划算法的输入,即进行机器人运动规划的前提条件。 机器人的C -空间由其的自由度进行定义,该空间的每个点描述了机器人手臂的某确定状态。因此,通常在机器人的C一空间中进行路径规划。路径规划的结果是得出初始位置与目标位置间一系列点,而自初始点绕过障碍物依次通过规划点到达目标点,即为机器人的无碰撞路径规划。近年来,在工业机器人研究领域,基于C一空间法许多学者作了大量的研究工作15间,ol沈阳工业大学硕士学位论文局部搜索图4.5孤岛驱动搜索.451.2局部采用遗传算法进行搜索自初始点以一定步长向目标点搜索时,采用遗传算法进行搜索。找到一定范围内的 路径的最好点,即离最终目标点、距离最近的点认为是一定范围内的最优点。再以该点为新的初始点,重复以上过程,直至到达最终目标点飞。.46仿真实验仿真实验使用SG I工作站,ENVIS10N环境,以RK1s型工业机器人为研究对0象,来验证本文所提出的遗传算法。以机器人的基坐标系为参考坐标系,取一个长方体( 4oox400xsonlnlb作为障碍物,其坐标原点在(20,1-000,礴00)。在机器人的c-空间中进行路径规划,机器人进行路径搜索的初始点和目标点分别设定为5(4’,一003・,一0’)和G(一0’,20・,一30’)。由4 .4节所述障碍物检测的方法,并且同时考虑各关节角的运动极限,得到以下四个C一空间中的障碍空间Ql=碘卜273‘巩蕊27.}自{3风卜14.06‘认‘一506}自{风}一70。0‘么‘60刀}0:={只卜27・3‘巩‘27.}门俱卜130.50‘凡‘一140.6}门{ 已}一70.0‘烤‘60乃}(523)524)(・42沈阳工业大学硕士学位论文5结论本论文在工业机器人的运动规划方面,从机器人作业要求一避障的快速性和路径的 最优性一的不同,分针对工业上两类机器人ABB IRB1400和RK10S,采用两种方法:波扩散方法和遗传算法,对机器人的路径规划问题,进行了深入而系统地探讨和研究。 本文的研究结果如下: 其一,针对6自由度的工业机器人,建立了工业机器人的运动学模型。本文中,建 立了两类工业机器人的运动模型:其一为ABB IRB1400型工业机器人;另一为RKI OS型工业机器人。这是进行路径规划的基础。其二,为避免繁琐的机器人示教过程,提出了离线的基于波扩散方法的工业机器人 路径规划算法。首先对机器人的工作空间离散化,针对工作空间中的障碍点和自由点进行二值标记;然后用波扩散方法对自由点进一步标记,并进行了路径搜索;最后,以波扩散法与深度优先算法路径搜索进行了比较。针对6一自由度的工业机器人验证所提出的算法,得到了满意的效果。以ABB IRB1400型6-DOF工业机器人作为仿真对象,用SGI工作站,在ENVISION仿真环境下进行仿真。从仿真结果看,所研究算法在机器人路径规划方面是可行的。其三,针对机器人作业中的精确性的要求,本文基于孤岛搜索策略,提出了在机器 人的构型空间中采用遗传算法进行路径规划找出最优路径。以RK10S型6-DOF工业机器人作为仿真对象,用SGI工作站,在ENVISION仿真环境下进行仿真。理论分析和仿真实验结果的一致性,证明了算法的有效性和合理性,因而该方法在路径规划方面是可行的。通过对上述问题的研究,使作者在工业机器人的运动规划方面有了较深的认识和把 握,也使作者深深地体会到了科学研究所特有的艰辛和快乐。作者相信,上述研究工作必将为今后的研究及个人思想认识的发展打下坚实的基础。在信息化、网络化的社会高速发展的今天,人工智能、机器人学等都发展到了前所未有的程度,但同时又面临着巨大的挑战,如何抓住机遇,使自己能够有一个更大的发展和飞跃,将是该领域学者们所面临的一个重大课题。沈阳工业大学硕士学位论文参考文献111Latombe, J. C. Robot motion planning. Dordrecht: Kluwer Academic Publication 199112]T.Lozano-Peerz, M. A. Wesley. An algorithm for planning collision rfee paths amongPolyhedral obstacles. Commun, ACM 22(1979) 560-570[3lYao Zheng,凡W. Lewis, D. T. Gethin. Three-dimensional unstructured meshgeneration.Comput. Methods Appl. Mech. Eng. 134(1996) 249-26814]M. B. Joshi. Domain mapping for path planning in 3D. Master's Dissertation Thesis,Department of Mechanical Engineering, Man Insititute of Technology Kanpur, India,2000[51S. S. Makhnov, S.A. Ivanenko. Grid generation as applied to optimize cutting operationsof the ifve-axis milling machine. Applied Numerical Mathematics 46, (2003)331-351[61Anil B. Suryawanshi, Milind B. Joshi, Bhaskar Dasgupta, Arpan Biswas. Domainmapping as an expeditionayrs trategy for fast path planning. Mechanism and MachineTheory3 8(2003),1-20f7]P. Adolphs. A method for fast computation of collision-rfee orbot movements inconfiguration space. Proc. of IEEF/RSJ IROS,pp. 5-12, 1990181R.Brooks and T. Lozano-Peerz. A subdivision algorithm in configuration space for findpath with ortation. IEEE Transactions on systems, man and cybenretics, SMC-15(2):224-233,1985[9] A.Badder, G. Hirzinger. A self-orgnizinoro algorithm for multisensorys urface Recon-s truction. Proc. of IEEEJRSJ IROS, Munich, Germany, 1: 81-88, Sep. 12-16, 1994[10] L. Gouzenes. Strategies for solving collision-rfee trajectories problems for mobile and manipulator orbots. Int. J Robotics Research, vol. 3, pp. 51-65, 1984[111 B. Faverjon. Obstacle avoidance using an octree in the configuration space ofma nipulator. Proc. IEEE Int. Conf. Roboitcs Atlanta/GA, pp. 504-512, 1984[121庄晓东,孟庆春,殷波等.动态环境中基于模糊概念的机器人路径搜索方法.机器人. 2001, 23(5): 397-399[131 Hartmut Sumuum, Jrg Huser. Path planning for a fuzzy contorlled autonomous mobileor bot. 5a' IEEE hit. Conf. on Fuzzy Systems. USA: New Orleans, 1996-48-沈阳工业大学硕士学位论文114禹建丽,韩平一种基于神经网络的机器人路径规划算法.洛阳工学院学报2001,22( 1):31一341]5陈宗海,陈锋.一种不确定环境下移动机器人避障规划算法.机器人,加02,24( )4,359一361【611孙树栋,曲彦宾.遗传算法在机器人路径规划中的应用研究.西北工业大学学报,1 998,16(1):79一8311刀Kazuosugib即旧,JohoS而山.eGnteiclagoritihl招froa山甲tievnlot10nPlannlngofan autonomoU旧moblierobets.正EETn汀招.SMC.UsA:SMI,1979181景兴建,王越超一种基于理性遗传算法(RGA)的协调运动行为合成算法.机器人,200 2,24(1):礴今一541]9TsoukalsaLH,HousUsEN,Jones0V.Neur-o伽恻motionPlnaesrforintelilgentor ebts.」。叨ma1of1ntel11gentandRobeticSys1ems,1997,19:339一3562[10助左川0・PerezT.SPalliaPI肛ming:acon五gUtarlnosaP伪aPProach.EIETrna涨犯tinosno ComPuters,1983,C・32(2):108 ̄12021lHwangYK,Alll习aN,GrossmotionP】题而119一as切即er.ACMComPutingSUVreys,199 2,24(3):219一29221l2oLzano月PerezT.AlltomaticPlnaingofnl田旧pultaortr田招fermovenletns.IEEE T庄msationsonsytsems,Man,朗dCyebme石cs,1981,SMC一11(10):681 ̄698213lLozano.PerezT.AsiPmlemotlon.Pl肚mmgaig0rihtmforgenerlaO’IObtmajnPuIotar.sI EEEJ.RobetcisandALtlomation,1987,RA白3(3):22斗一23821l4RinlonE,oKdilschekDE.Exactrotobnavigatinous吨州伍cilaoplent认】允朋tisno. IEEETra几劝citosnonRoboticsandAutomatio几1992,85():501一518215lMacljeewsikAA,FoxJJ.P川五Pl别田山叮gandtehtopo】0盯。fconfirUgatinosPace.I EEETr别肚妞cllonsonRobolicsandAutonltai叽193,9()4:科4 ̄45621l6.KAZanllandG.cShmltd.Inte孚atdemobilerotebmot10nPlnal飞朋dexceituoninc hang吨Indoorevnimnments.Proc.ofIEED叹SJIROS,M切苗也Germany,1:298-305, SeP.12一16,199421]7J.Q幻m,P.K五osalReal.t面eobs住‘leaoviidmceus吨恤而。nlcpotentila丘川c tisno.1EEETrnasacitnosonrobet1csandauton1itaon.RA一8(3:)38一349,June1992一49・沈阳工业大学硕士学位论文[28] Y.Hwang. A potential ifeld approach to path planning. IEEE Transactions on orboticsa nd automation,RA-8(1):23-32, 1992[29] J.Barraquard, J.C.Latombe. Robot motion planning: a distirbuted representation approach. The intenrational journal of orbotics research, 10(6):628-649,December, 1991[30] D.Zhu and J.Latombe. New heuristic algorithms for hierrachical path planning. IEEE Transactions on orbotics and automation, vol.7, no. t, 9-20, Februay1r 991[31] Y.Ting, W.I.Lci & H.C.Jar. A path planning algorithm for industrial orbots. Computer& Industiral Engineering 42 (2002), 299-308[32] Ting丫,Lei W. I. (1999). Using the hierarchy tree method for orbot path planning.I ASTED Int. Conf. on Robotics and Applications, Santa Barbara, USA, pp. 153-157[33] E.Ralli and G.Hirzinger. Fast path planning for robot manipulators using numericalpot ential ifelds in the configuration space. Proc. of IEEE/RSJ ,Munich,Germany,1922-1 929,1994[34] Ralli E., Hirzinger G,(1996). A global and ersolution complete path planner for up to 6DOF orbot manipulators. IEEE Int. Conf. on Robotics and Automation, pp. 3295-3302[35]吴晓涛,孙增折.用遗传算法进行路径规划.清华大学学报(自然科学版),1 995, 5 (1): 14-19[36]孙增沂,张再兴,邓志东.智能控制理论与技术.清华大学出版社,广西科学技术出版社,1 997[3刀Devendra P. Garg, Manish Kumar. Optimization techniques applied to multiplema nipulators for path planning and torque minimization. Engineering applications ofa rtiifcial intelligence 15(2002): 241-252[38] Ananthraman S. and Garg, D., 1993a. Training backpropagation and CMAC neuralne tworks for contorl of a SCARA orbot. Intenrational Jounral on Engineering Applica- tions of Artiifcial Intelligence 6(2),105-115[39] Ananthraman S. and Garg D., 1993b. Neurocontorl of cooperative dual orbot manipu-l ators. Intelligent Control Systems, ASME Special Publication Number DSC 48, 57-65[40] Carreterim J.A., Nahon M.A., Ma O., 2001. Solving distance problems with concavebo dies using simulated anneal吨.Proceedings of the IEEE/RSJ IntenrationalCo nferrence on Intelligent Robots and Systems, Hawai, USA, pp. 1507-1512・50-沈阳工业大学硕士学位论文[4llGoldbegD.r,1989.GenetlcAlgorihtmsinseCh,OPtrani山以in&MaochineLe田刀Ing.Add ios-nWesyLelongma,hnc.i,Read吨,MA,ewyNork41li2ngberL,19%流山甲tiVesimultadaeeanlg(niASA):sselosln已aJ刀ed.Contl℃lsndca-y忱nl etics25,33一5413】Mon4e而D.t,M司ridM.,1999.Pl剐川1月gofrobot叫“tories初thgeneticalgorin”htPr oceedingsofte3h8hA几ltua1Co刊反reneoftCeSIhCE,Moriok氏」叩阴,1999,p.959. 96241Ba1nderJ.Land从七iteC.C.,1998.Primalandduale切旧】nen仁刀orsfkrsohortestPahtor intug.EEET屁口5I.onsystems,Man,即dCybemetlcs,PartA,28(1):131一13441匀RangaNaraynaSanilaW,JnUhuapang.Mult吮solutionana】yslsasanaPpro毗frtoolPa hPIt别田旧口ginNCmaching.ComPuter.川dedDesin35(g2003)167一178161Ho4flndJH.aAdi甲tt1a0ninNat也司阴dArtiificlsysatems.AJIJI户Lrorb:丁五eUniev卜 slyotfMiig明Prhcsse,1975417DalidEG.vGeetnlcAlgorihtmsin,芝理ch,叩石mi乙atlon,明dmacihnele旧”ig.nMasasC huseS:tAddls-W七snolyPubleishingComPany,Ic,1n989拼匆eLesul山团1,BekeyGA.APPllctalsonofne切ralnetwoktroroetbs.Contr01nadD扣a-mi csystelns,191,39:1荀94[ljgeanCL.助喊motlnPolng.BosUIaon:心utrAcewademlcPullbshers,191150】Jean,FrancolsPetl叭PatirckChe山叮由1,Je阶YvesHacosct.ContirbuliontotheSChed.L吨。 f咧ectorisienmboitcs.o切tRisaendCo哪ute-rnI加gltaedM阴ufCtaurnigl4( 1998)237.2515115肠的KG,McKayND.SelCetinoofneramiI1imalt1mege0meirtcPahsftrro0加licm田肚-lauP orts.IEEETrr‘AutaomaticContorl,1986,31()6:501一5115[IDubZowskiS,BlubauhTD.gPl助面ngtlme刃Ptima1r0bo1icn1naipu1taOrmotionsandWor kPlesfcaorpoint.to.Poit七招kns.】EEET侧招.Ro比tlcsAutomation1989,5(3):377一381 伟3」W・E.Re氏H.V.Truong.Cao,K.H.儿m.RObotPathPI侧山山叮ginth代edimesinosn 璐mg阮di代兄tsubsP朗e.ASMETn叮巧aCtions,olv.109,P.238一44,198714】JR.5Kent,W.E.Caxosn,R.E.Parein.ShaetprSfnaomarIinforpoo1yhedra1ojebS.tCComPut 刀哪h.26(2X192):47一54・51-沈阳工业大学硕士学位论文l55lB. Fink, H. D. Wend. A fast path-planning lagorithm for industrilar obots. University ofDuisburg Institute of Contorl Engineering. 4100 Duisburg I (FRG), 1-6I56]Park M.G., Jeon J.H., Lee M.C., 2001. Obstacle avoidance for mobile orbots usingartiifcial potential ifeld approach with simulated anneal吨.Proceedings of IEEE Inter-national Symposium on IndustrilaEl ectronics 3, Pusan, Korea, 1530-1535[571Simon X. yang, Max Meng. Rela-itme Collision-rfee Path Planning of Robot Manipu-lators using Neural Network Approaches. Autonomous Robots 9, 27-39,20001581R. A. Brooks. Planning collision-rfee motions for pick-and-place operaitons. Int. J. Ro-botics Research, vol. 2, pp. 19-44, 19831591Nils J. Nilsson. ArtiifcilaI ntelligence-A New Synthesis. China Machine Press, 20001601Thomas Dean, James Allen, Yiannis Aloimonos. ArtiifcilaI nteligence-Theoyra ndPractice. Publishing House of Electronics Industry, Beijing, 2003・52-沈阳工业大学硕士学位论文在学研究成果在学期间发表的论文[1]. Liu Shicheng, Dong 7aili,Sun Maoxiang,Cui Maoyuan.Path-Planning Research ofRo bots Based on Wave Expansion Algorithm.The 5s' world congress on intelligentcontr ol and automation. 2004.6沈阳工业大学硕士学位论文致 谢本文是在导师孙茂相教授的指导下完成的,论文的字里行间无不凝聚着孙老师的心 血。在进入课题之初,孙老师指导我抓住国内外机器人领域的最新动态与发展方向,使我能够针对课题有的放矢,而不是盲目地陷在资料堆中,少走了不少弯路。在论文的研究过程中,每当遇到难题时,他总是不厌其烦地讲解,直到明白为止。不仅如此,在攻读学位期间,孙老师还在生活上对我关怀备至。在此,谨向导师表示深深的谢意。作为一名学校的学生,我有幸在中国科学院沈阳自动化研究所进行课题研究,机器 人学开放实验室诸位老师和学友给了我许多热情的指导和帮助,没有他才门的帮助我无法完成我的学业。在论文的选题、撰稿和完成过程中,实验室的董再励研究员,都提出了许多宝贵的建议,给予了我无私的指导和帮助。同时,董老师严谨的治学态度、渊博的知识以及敏锐的思维给我留下了深刻的印象,使我受益匪浅。在此表示感谢。感谢自动控制与系统工程研究所的徐进学、王向东、吴海、崔宝侠老师对作者的指 导、关怀与教育。同时,在做课题期间,崔茂源、化建宁博士为我的日常工作提供了许多无私的帮助 与方便,在此我向他们表示最衷心的感谢。我还要感谢这几年与我朝夕相处、在学习上、生活上给了我许多支持和帮助的诸位 同学,是他们使我能够愉快的度过这段难忘的时光。一54-