基于A_算法的空间机械臂避障路径规划_贾庆轩.pdf

发布时间：2022-06-14 发布人：admin 分类：说明书资料大小：0.94M 资料格式：pdf 举报版权申诉

8e1230de-3d21-41f6-814f-fbd38442a7f6.pdf-第1页.png

第1页 / 共7页

8e1230de-3d21-41f6-814f-fbd38442a7f6.pdf-第2页.png

第2页 / 共7页

8e1230de-3d21-41f6-814f-fbd38442a7f6.pdf-第3页.png

第3页 / 共7页

8e1230de-3d21-41f6-814f-fbd38442a7f6.pdf-第4页.png

第4页 / 共7页

8e1230de-3d21-41f6-814f-fbd38442a7f6.pdf-第5页.png

第5页 / 共7页

8e1230de-3d21-41f6-814f-fbd38442a7f6.pdf-第6页.png

第6页 / 共7页

8e1230de-3d21-41f6-814f-fbd38442a7f6.pdf-第7页.png

第7页 / 共7页

文本预览

第 46 卷第 13 期 2 0 1 0 年 7 月机械工程学报 JOURNAL OF MECHANICAL ENGINEERING Vol.46 No.13 2 0 1 0 Jul. DOI：10.3901/JME.2010.13.109 基于 A*算法的空间机械臂避障路径规划* 贾庆轩陈钢孙汉旭郑双奇 (北京邮电大学自动化学院北京 100876) 摘要：针对空间机械臂在轨操作任务需求，提出一种基于 A*算法的避障路径规划算法。根据机械臂和障碍物几何特征，对机械臂模型和障碍模型进行简化。通过研究机械臂本身所固有的几何特性，根据障碍物的位姿坐标，分析机械臂各杆件与障碍物发生碰撞的条件，进而求解空间机械臂的无碰撞自由工作空间。在此基础上，利用 A*算法在空间机械臂的自由工作空间进行无碰撞路径搜索，实现了空间机械臂的避障路径规划。通过仿真试验验证了基于 A*算法的空间机械臂避障路径规划算法的有效性与可行性。关键词：空间机械臂避障路径规划 A*算法中图分类号：TP242 Path Planning for Space Manipulator to Avoid Obstacle Based on A* Algorithm JIA Qingxuan CHEN Gang SUN Hanxu ZHENG Shuangqi (Automation School , Beijing University of Posts and Telecommunications, Beijing 100876) Abstract：A novel path planning method to avoid obstacle based on A* algorithm is presented for space manipulator to accomplish the in-orbit mission. According to the geometric characteristics of manipulator and obstacle, the manipulator model and obstacle model are simplified. On the basis of the inherent geometric characteristic of manipulator, and according to the position and orientation coordinates of obstacle, the collision conditions of all links of manipulator are analyzed. And then, the collision-free workspace of space manipulator is obtained. On this basis, the collision-free path search in the free workspace of space manipulator is carried out by using A* algorithm, thereby, the obstacle avoidance path planning is achieved. The effectiveness and feasibility of the proposed path planning algorithm based on A* algorithm for space manipulator to avoid obstacle are verified by simulation and experiment. Key words：Space manipulator Obstacle avoidance path planning A* algorithm 0 前言* 随着空间探索的不断深入，空间机械臂应用技术已经成为空间技术的重要研究方向。空间机械臂代替宇航员完成空间作业任务，如组装与搭建空间站、释放与回收卫星、维护空间设备以及完成空间科学试验等，大大减小了宇航员舱外作业的风险，因此空间机械臂应用技术受到国内外专家的高度重视。在微重力环境下，空间机械臂系统处于自由漂 * 国家高技术研究发展计划资助项目(863 计划，2009AA7041007)。 20100324 收到初稿，20100504 收到修改稿浮状态，使得机械臂控制变量与非独立变量之间存在强烈的运动耦合，运动控制难度加大，从而空间机械臂的路径规划变得特别复杂[1]。此外，由于空间环境中的空间碎片，空间舱体外设试验装置等都有可能成为空间机械臂在轨操作过程中的障碍，因此为了顺利完成在轨操作任务，开展空间机械臂避障路径规划研究十分重要。避障路径规划是指在给定的障碍条件以及起始和目标的位姿，选择一条从起始点到达目标点的路径，使运动物体能安全、无碰撞地通过所有的障碍[2]。目前，针对机械臂避障路径规划提出了许多方法，其中最为典型的包括基于自由空间法和人工

110 机械工程学报第 46 卷第 13 期期具体的构型 D-H 坐标系与参数分别如图 1 和下表所示。机械臂杆件均为圆柱体，因此机械臂杆件碰撞模型采用圆柱模型，且其半径均为 0.15 m。图 1 机械臂 D-H 参数坐标系图列公式，提出了基于动力学约束的机器人无碰路径序号势场法两种。LOZANO-PEREZ[3-4]提出了基于 C 空间的自由空间法。首先以机械臂的关节坐标系建立 C 空间，将障碍物映射到 C 空间，形成空间构型障碍，从而求得 C 空间的补集，即自由空间。在此基础上，利用启发式搜索算法在机械臂的自由空间内寻找机械臂的运动路径。该方法虽然能够实现机械臂无碰撞路径规划，但是由于将障碍物映射到 C 空间方法较为复杂，对于复杂环境难以满足实时性的要求。KHABIT[5]对障碍定义一个排斥势场，目标点处定义一个吸引势场，机械臂的运动由两个势场共同作用力来决定，由此来保证机械臂在避障的同时顺利到达最终目标点。该方法对于处理全局路径规划中的动态避障非常有效，但容易陷入局部最小点处。FIORINI 等[6]提出了基于速度的 C 空间法，该方法能够实现机器人移动障碍物环境中的避障，但该法只适用于移动机器人的避障路径规划。李大生等[7] 利用系统内能方法推导了机械臂无碰运动规划的系规划方法，但由于该方法涉及动力学计算的推导，对于 6 自由度空间机械臂采用该方法太过复杂。目前，国外针对空间机械臂避障路径规划算法的研究主要集中于国际空间站的冗余度机械臂。 SAKATA 等[8]基于梯度投影法提出了一种空间冗余度机械臂的避障路径规划算法，该方法主要利用冗余度机械臂自运动的特点实现其实时的避障路径规划，不适用于非冗余机械臂。SHAFFER 等[9]提出了基于八叉树空间机械臂的避障路径规划算法，该方法需要预先构建空间机械臂整个工作空间的八叉树模型，在此基础上实现空间机械臂的实时避障路径规划，因此机械臂工作空间中的物体位置的改变和空间漂浮物的漂移都需重新构建机械臂的工作空间的模型。本文针对具体的空间机械臂构型，首先对空间机械臂的模型和障碍物模型进行合理的简化；在此基础上，将笛卡尔空间障碍物映射到关节空间，进而求得机械臂的自由运动空间；利用 A*启发式搜索算法在机械臂的自由空间内进行了路径搜索；最后，通过仿真试验对本文提出的空间机械臂避障路径规划算法进行了验证。 1 碰撞模型 1.1 空间机械臂模型表机械臂 D-H 参数表扭角 /iα (° ) 连杆长度 / mia 连杆偏置 / mid –90 0 0 90 –90 0 0 2.5 3.0 0 0 0 0.5 0.3 –0.3 0 0.3 0.6 关节角 /iθ (°) 1θ (90) 2θ (0) 3θ (0) 4θ (0) 5θ (–90) 6θ (0) 1 2 3 4 5 6 1.2 障碍模型三维障碍物一般具有不规则的几何形状，因此本文利用障碍物的规则体包络来近似建模，这种建模方法虽然在一定程度上扩大了障碍域，但是使障障碍物可以采用球形包络描述为 0( , 碍域大大简化，有效地提高了规划的效率，同时也使得整个机械臂避碰路径规划更具有安全性。 )S S P r ，如 P x y z 为球心在基坐标系中图 2 所示。其中， 0 的坐标， Sr 为球的半径，这种障碍物的球形包络近似的求取方法，大大简化了计算，方法简单直观。 ( , 0 , 0 ) 0 本文研究的机械臂为 6 自由度空间机械臂，其图 2 障碍物的球形包络几何模型

月 2010 年 7 月贾庆轩等：基于 A*算法的空间机械臂避障路径规划 111 2 笛卡尔空间障碍向构型空间的转化本文首先根据机械臂模型和障碍物模型将笛卡尔空间障碍通过几何关系向机械臂的构型空间进行转化，从而形成机械臂的自由运动空间，为利用 A*算法进行机械臂的无碰撞路径规划提供条件。 2.1 问题的提出空间机械臂在轨操作过程中，机械臂的运动会导致基座随之运动，因此空间机械臂的避障运动规划不仅与障碍物有关而且与基座的运动控制紧密结合。由于机械臂安装于基座上，当障碍物也固定于基座时，障碍物与机械臂安装位置间的相对位姿关系在整个机械臂运动过程中保持不变。此时，可以采用相对于基座坐标系的方式进行规划，障碍物向构型空间的转化只需要求解一次即可得出整个运动过程中机械臂的自由运动空间。当障碍物独立于基座时，机械臂的运动会导致障碍物相对于机械臂的安装位置发生运动，此时，需要采用相对于惯性坐标系的方式进行路径规划，因此每个控制周期都需要将障碍物向构型空间的转化，从而得出该控制周期机械臂的自由运动空间。为了便于分析和着重阐明本文提出的避障路径规划算法，本文以下均针对障碍物固定于空间飞行器基座的情况进行讨论，障碍物独立于基座的情况只是需要多次求解机械臂的自由运动空间，其求解方法与障碍物固定于基座模式相同。以下着重阐明求解机械臂自由运动空间方法。 2.2 总体思路本文研究对象为 6 自由度机械臂，其具有 6 个关节，每个关节角的旋转均可以引起机械臂与障碍物之间碰撞的发生，因此本文拟采用分级讨论的方法来求解障碍物与各杆件碰撞的条件。其总体思路为：首先求解关节 1 可能导致机械臂连杆与障碍发生碰撞的运动范围，后续各关节导致碰撞发生的情况均在该范围内讨论；在此范围之内可以推导出连杆 2 与障碍发生碰撞的条件；在连杆2 与障碍不发生碰撞所对应的关节角2 的范围内，讨论连杆 3 与障碍发生碰撞的条件；同理能够求得连杆 4，连杆 5 与障碍发生碰撞的条件。 2.3 杆件与障碍碰撞条件分析由于杆件 1 只作绕自身轴线的运动，因此杆件 1 与障碍发生碰撞的情况不作考虑。杆 1 与杆 2 之间的偏置量为 0.3 m，而杆件模型为半径为 0.15 m 的圆柱体，因此杆件 1、2 之间的偏置连杆与障碍发生碰撞的情况已包含在杆件 1、2 与障碍发生碰撞的分析过程中。同理，其余偏置连杆也均不作考虑。为了便于分析问题，在杆 3 与杆 4 之间的偏置连杆只考虑了两端各 0.15 m 部分，中间 0.3 m 部分未作考虑。因此以下针对杆 2、杆 3、杆 4 和杆 5 与障碍发生碰撞的条件进行分析。 (1) 可能发生碰撞的关节 1 运动范围。为了讨论杆件与障碍发生碰撞的情况，首先需要求解发生碰撞的关节 1 的运动范围。将图 1 中所示的机械臂在 Oxy 平面内投影，则关节 1 发生碰撞的两个极限位置如图 3 所示。图 3 碰撞发生的关节 1 极限位置图根据图 3 中的几何关系，可以求出障碍物中心在底面投影点与坐标原点连线的偏角 p 11 = arctan( θ (1) 求解关节 1 转动使整个机械臂不发生碰撞的角 ) p / x y θ∆ 11 θ∆ 12 d = arcsin( h2 d = arcsin( 度 11θ∆ 和 12θ∆ (2) (3) 式中， d1d 为障碍物中心底面投影到坐标原点的距离， h1d 与 h2d 分别为投影中心到关节 1 坐标系原点和关节 4 坐标系原点连线的距离。 d d1 d ) ) ) ) / / h2 d1 ∈ , ] π = , ] θ = θ 1min2 1max2 ∈ [ 1max1 。。 π = − 令 1min1 θ θ θ 11 11 θ θ 11 12 θ θ 11 11 θ θ 11 12 − ∆ ， 1max1 − ∆ ， 1max2 + ∆ ，则可能发生碰撞关节 1 部分运动范围为： θ θ θ 1 [ 1min1 又由于 1θ 转动具有对称性，负向时角度范围为 + ∆ 。由此 = − θ 1min2 可得可能发生碰撞的关节 1 的另一部分运动范围为： 1 θ θ θ 综上，可能发生碰撞关节角 1 运动范围为：。 (2) 杆件 2 与障碍发生碰撞条件。在可能发生碰撞的关节角 1 的运动范围内，任意给定一个 1θ ，求出 21p (杆 2 的起始点)的位置及杆 2 的方向矢量，并由障碍域中心位置与 21p 的距离 1d 判断球是否在杆 2 的碰撞范围内。关节 2 发生碰撞的极限位置如图 4 所示。 1θ Ω∈ ，其中： 1 1 Ω θ θ [ θ θ 1min2 ] ∪ = [ 1min1 1max1 , ] 1max2 ,

112 机械工程学报第 46 卷第 13 期期图 4 碰撞发生的关节 2 极限位置图 d 如果 1 + ，则不在其范围之内，无须进 a 2 R > 行进一步分析；否则，须进行如下计算。 2 ) ( = > r qie1 R r + bj R r + bj 1) 判断障碍物中心向杆 2 平面的投影距离 11d ，若 11 ( R 为障碍物半径， bjr 为碰撞裕 d 量)，则杆 2 不会发生碰撞。否则，可求出障碍物与杆 2 运动平面的切圆半径为 − ，垂点 1o 到 21p 距离为 12d ，由此可以计算出碰撞时的边界转动角为 (4) 2) 求解障碍物中心在杆 2 面上的投影点 1o 与 21p 连线矢量的方向角 2tempθ 。由平面与垂线交点的式子可求出垂点 1o 坐标，进而求出 1o 点与 21p 所确定矢量的角度 2tempθ 。 = arcsin( 2 d 11 θ∆ 2 r qie1 d 12 ) / 2 ± ∆ ，其中 3) 求解碰撞发生的 2θ 范围。由以上推导可知： 2temp θ θ θ 2 min{ = max{ = θ θ 2 θ θ + ∆ + ∆ } } 2min1 2temp = θ θ θ 2 θ 2 2temp 2temp 2max1 − ∆ − ∆ θ 2temp θ , , 2 由于 1θ 具有的对称性，则 π ， 2min2 π ， θ − 2temp θ − min{π max{π − ∆ − ∆ = = θ 2 θ 2 θ θ θ − 2temp θ − + ∆ + ∆ } θ 2 } θ 2 2max2 由此可得，对于给定的 1θ ，连杆 2 发生碰撞的 2temp 2temp 条件为： 2 θ Ω∈ ，其中 Ω θ θ = [ , 2 2min1 2 2max1 ] ∪ [ θ θ 2min2 , 2max2 ] 2 (3) 杆件 3 与障碍发生碰撞的条件。在 1 1θ Ω∈ θ Ω∉ 的范围内任意给定 1θ 、 2θ ，讨论杆 3 发且 2 生碰撞条件。过杆 3 建立垂直于 H 平面的 V 平面。根据给定的 1θ 、 2θ ，求解点 31p 的坐标，并由障碍域中心位置与 31p 的距离 d 判断障碍物是否在杆 3 的碰撞范围内。关节 3 发生碰撞的极限位置如图 5 d + ，则不在其范围，无须进行所示。如果 2 以下分析；否则，进行如下计算。 a 3 R > 1) 求解障碍物中心到 V 平面的距离 21d ，若 R r > + ，则杆 3 不发生碰撞；否则，求出障碍 bj d 21 物与杆 3 运动平面切圆半径，垂点 2o 到 31p 距离为 22d ，由此可以计算出碰撞时的 R r + bj r qie2 2 21 = − d ( ) 2 图 5 碰撞发生的关节 3 极限位置图边界转动角为 θ∆ = (5) 2) 求解垂点 2o 与 31p 所确定矢量的方向角，在 arcsin( r qie2 d 22 ) / 3 关节 3 坐标系下，可得 3 min{ max{ o / z 2 } θ θ θ θ 3 3 } θ θ θ θ 3 θ = − ∆ − ∆ o y 2 + ∆ + ∆ arctan( θ θ = = 3max , , 3min 3 3 3 3 3 ) ，则由此可得，有可能发生碰撞的关节角 3 运动范围为： 3 θ Ω∈ ， 3 Ω θ θ 3min = 3 3max [ , ] 。杆 4 和杆 5 与障碍发生碰撞的条件分析方法与杆 3 分析方法相同，可得出有可能发生碰撞的关节 4Ωθ ∈ ，角 4 运动范围和关节角 5 运动范围分别为： 4 , Ω θ θ Ω θ θ ，此处不再做进一步分析。 5Ωθ ∈ ， 5 ； 5 5max 4max 4min 5min = = [ ] [ ] , 4 以上分析计算过程均采用解析的数学公式进行，因此利用以上的方法可以将笛卡尔空间障碍物实时地转化到关节空间，从而求出了机械臂的自由运动空间。 3 基于 A*算法的无碰撞路径规划 A*算法是一种启发式搜索方法，在搜索中加入了与问题有关的启发性信息，指导搜索朝最有希望的方向进行，用于搜索状态空间的最短路径[10]。 3.1 算法思想 A*算法是人工智能中典型的启发式搜索方法，被广泛应用于最优路径求解的问题中。A*算法的核心部分，在于估价函数的设计。在选择当前结点的 f x 下一个考察节点时引入了估价函数 ( ) + = f x ( ) h x ( ) g x ( ) (6) f x 表示从起始节点到节点 x 的一条最佳路 ( ) 径的实际代价加上从结点 x 到目标节点的一条最佳路径的代价之和。而 ( )g x 就是从起始节点到节点 x 之间最小代价路径的实际代价， ( )h x 则是从 x 节点到目标节点路径的估计代价。 3.2 基于 A*算法的路径规划方法为了便于利用 A*算法，定义空间机械臂的 6 个关节角度为一个六维数组，起始关节角度为

月 2010 年 7 月贾庆轩等：基于 A*算法的空间机械臂避障路径规划 113 ；第 i 步的后继节点关节角 suc_i[6] q ；第 i 步最佳关节角，由 l ；关节角搜索步长 step[6] q int[6] q 度为 best_i[6] 搜索步长确定；期望关节角为 des[6] ∑ q i 定义估价函数中 g q ( ) i = q i 。 [6] − q i -1 [6] ， m 1 = m ,6 ] [ ] [ des − = max 1,2, = q m q m i ，由此可以求出第 i 步 h q ( ) i if q 。选择第 i 步后继后继节点关节角的估价函数 ( ) if q 值最小的节点作为此步的最优节点关节角中 ( ) 关节角，根据步长生成第 1i + 步的后继节点关节角，重复此过程可保证每一步都得到最优关节角，因此通过该估计函数的启发式信息可以实现机械臂从起始关节角到目标关节角的关节空间最优路径搜索。为了便于分析，设定 3 个表，即 OPEN、CLOSE 放入 OPEN 表，初和后继节点表，把起始点 int[6] 始化 0 ，置 CLOSE 表为空表。 f q ( ) 重复下列过程，直到找到目标节点为止。若 OPEN 为空表，则宣告失败；否则，开始以下循环。 (1) 选取 OPEN 表中未设置过的具有最小 f 值，并把它放入 CLOSE 表， h q ( ) 0 的节点为最佳节点 best_i[6] 同时将其从 OPEN 表中删除。 = q q (2) 判断 best_i[6] 是否为目标节点 des[6] 是，则求解成功，循环结束；否则，转至(3)。 q q ，若 (3) 根据设定的步长 step[6] l 值计算，产生后继节点 suc_i[6] q 。 q (4) 对每个后继节点 suc_i[6] 1) 判断 suc_i[6] 是否在机械臂的自由运动空间 q 进行下列过程。的指针；否返回 best_i[6] q q 内，若是，建立从 suc_i[6] 则，转至(3)。 2) 计算 g q ( ) i = 3) 判断 suc_i[6] q i − q i [6] [6] q − i 1 ∑ m 1 = 是否在 OPEN 表中，若是，转。至 4)；否则，转至 5)。 [6] 4) 定义数组 old_i q q= suc_i [6] ，将 old_i[6] q 填到 > g q ( [6]) 的后继节点表中，进而比较新旧路径代价。 q best_i[6] g q ( 判断 old_i q 新 old_i[6] g q [6]) ( [6]) 并转至 7)；否则，停止扩展此节点并转至 7)。 [6]) 的父辈节点为 best_i[6] g q ( = ，进一步修正 old_i ，并更新 f q ( 是否成立，若是，则更 [6]) suc_i suc_i old_i 值 q 5) 判断 suc_i[6] q 是否在 CLOSE 表中，若在，则转向 4)；否则，转至 6)。 6) 将 suc_i[6] q 放入 OPEN 表中，并添入到 q best_i[6] 的后继表中，转至 7)。 7) 计算 suc_i f q ( [6]) ，并转至 1)。循环结束时，顺序输出 CLOSE 表中的数据即为空间机械臂运动的无碰撞最优路径。根据以上的分析可以得出，基于 A*算法的空间机械臂避障路径规划算法流程图如图 6 所示。图 6 基于 A*算法机空间械臂避障路径规划流程图 4 试验与仿真为了验证以上提出的基于 A*算法的空间机械臂路径规划算法，以带有漂浮基座的 6 自由度空间机械臂为例开展仿真验证工作，其具体构型的坐标系和 D-H 参数如图 1 和上表所示。障碍物模型采用半径为 0.5 m 的球体模型，如图 2 所示。利用 Visual C++开发环境，搭建了空间机械臂仿真系统，并基于 OpenGL 开发了空间机械臂仿真模型，可进行空间机械臂运动学和动力学分析。该仿真系统的运行平台是主频 2.4 GHz、内存为 1 GB 的计算机。试验中机械臂的控制周期为 100 ms。为了验证提出的避障规划算法，分别设计杆 2 和杆 3 避障碍物运动规划的试验。设两个试验中，

114 机械工程学报第 46 卷第 13 期期 − 机械臂的初始构型均为{25°, –54°, –49°, –7°, 7°, 0°}，期望关节角度均为{30°, 10°, –49.5°, 47.5°, 6.5°, 0°}，其对应的目标点位姿为{ 0.88, 4.80, 3.16, 36.5°, 0.9°, –98°}，其中前 3 项是位置坐标，后 3 项是 ZYX 欧拉角。 4.1 杆 2 避障碍物运动规划试验 } 1,1,2 。利用本文提出的基于 A*算法的空间机械臂避障碍路径规划算法可以得出机械臂的无碰撞路径。整个运动过程如图 7 所示。设定障碍物的位置为{ (a) 初始状态 (b) 避障状态 (c) 终止状态图 7 空间机械臂杆 2 避障路径规划仿真图从图 7 可以看出，如果机械臂从初始状态到达终止状态如采用最短路径原则进行路径规划时，杆件 2 必然会与障碍物发生碰撞。而利用文中提出的基于 A*算法的避障路径规划算法只在机械臂的自由运动空间内进行机械臂关节角的最优运动路径搜索，因此在杆件 2 接近障碍时，顺利地实现了其避障碍运动，保证了整个机械臂运动过程中无碰撞发生。图 7 中灰色曲线为机械臂末端的运动轨迹。 4.2 杆 3 避障碍物运动规划试验 } 0.5,2.0,5.0 − 设定障碍物的位置为{ 。利用本文提出的基于 A*算法的空间机械臂避障碍路径规划算法可以得出机械臂的无碰撞路径。整个运动过程如图 8 所示。 (a) 初始状态 (b) 避障状态 (c) 终止状态图 8 空间机械臂杆 3 避障路径规划仿真图从图 8 可以看出，利用文中提出的基于 A*算法的避障路径规划算法顺利地实现了杆 3 的避障碍运动，保证了整个机械臂运动过程中未与障碍球发生碰撞。图 8 中灰色曲线为机械臂末端的运动轨迹。在仿真过程中，测试两个试验的整个过程计算时间分别为 9.2 ms 和 8.9 ms，能够满足控制周期的实时性的要求。通过以上两个试验可以证明本文中提出的基于 A*算法的避障碍路径规划能够顺利地实现空间机械臂连杆与障碍物之间的避障碍运动，整个运动过程平稳，速度连续，因此，该算法能够应用于空间机械臂的实际控制过程中。 5 结论针对空间机械臂在轨操作应用过程中可能与环境中障碍发生碰撞的情况，在将障碍从笛卡尔空间向关节空间转化的基础上，利用 A*启发式搜索算法实现了空间机械臂的无碰撞路径规划。 (1) 文中利用机械臂的几何关系实现了将空间障碍向关节空间的转化，求解出了机械臂的自由运动空间。该方法主要基于杆件和障碍物的几何关系，并通过计算分析得出了杆件和障碍物发生碰撞条件的解析表达式，因此利用该方法求解机械臂的无碰撞路径规划计算量小。 (2) 利用 A*算法在机械臂的自由运动空间进行路径搜索，可以实现机械臂的无碰撞路径规划。同时由于在整个机械臂关节空间路径搜索过程中，根据启发式信息进行了关节角的寻优，因此利用该方法得出的关节角序列为机械臂从起始关节角运动到目标点关节角的关节空间最优路径。 (3) 对于空间漂浮物体仅仅需要将其空间位姿坐标变换到机械臂基座坐标系下，然后利用文中提出的将空间障碍向关节空间转化的方法即可求出其当前状态下机械臂的自由运动空间，在每次路径搜索前更新机械臂的自由运动空间即可。参考文献 [1] 陈靖波，赵猛，张珩. 空间机械臂在线实时避障路径规划研究[J]. 控制工程，2007，14(4)：445-450. CHEN Jingbo，ZHAO Meng，ZHANG Heng. On-line real-time obstacle avoidance path planning of space manipulator[J]. Control Engineering of China，2007， 14(4)：445-450. [2] 黄献龙，梁斌，吴宏鑫. 机器人避碰规划综述[J]. 航天控制，2002，1：34-40. HUANG Xianlong，LIANG Bin，WU Hongxin. A survey

月 2010 年 7 月贾庆轩等：基于 A*算法的空间机械臂避障路径规划 115 on robotics collision avoidance planning[J]. Aerospace Control，2002，1：34-40. [3] LOZANO-PEREZ T. Automatic planning of manipulator transfer movement[J]. IEEE Transaction on Systems Man. and Cybemetics，1981，SMC-11(10)：681-698. [4] LOZANO-PEREZ T. Spatial planning：A configuration space approach[J]. IEEE Transaction on Computers， 1983，C-32(2)：108-120. [5] KHABIT O. Real-time obstacle avoidance for manipul- ators and mobile robots[J]. The International Journal of Robotics Research，1986，5(1)：90-98. [6] FIORINI P，SHILLER Z. Motion planning in dynamic environments using the relative velocity paradigm[C]// Proceedings of the IEEE International Conference on Robotics and Automation，May 2-6，1993，Atlanta， GA，USA. Piscataway，N.J.，USA：IEEE，1993：560-565. [7] 李大生，刘欣，吴明华，等. 基于动力学约束的机器人无碰运动规划[J]. 机器人，1990，12(5)：14-19. LI Dasheng，LIU Xin，WU Minghua，et al. Collision-free movement planning of robots with dynamic constraints[J]. Robot，1990，12(5)：14-19. for mobile servicing system[C]// system concept Intelligent Robots and Systems ′91. Intelligence for Mechanical Systems，Proceedings IROS 91. IEEE/RSJ International Workshop，November 3-5，1991，Osaka. Washington，DC，USA：NASA，1991：1 641-1 646. [9] SHAFFER C A，HERB G M. A real-time robot arm collision avoidance system[J]. IEEE Transaction on Robotics and Automation，1992，8(2)：149-160. [10] 赵真明，孟正大. 基于加权 A*算法的服务型机器人路径规划[J]. 华中科技大学学报，2008，S1：196-198. ZHAO Zhenming，MENG Zhengda. Path planning of service mobile robot based on adding-weight A* algorithm[J]. Journal of Huazhong University of Science and Technology，2008，S1：196-198. 作者简介：贾庆轩(通信作者)，男，1964 年出生，博士，教授，博士研究生导师。主要研究方向为机器人学、空间机器人技术和虚拟现实技术。 E-mail：sdjqx@sohu.com 陈钢，男，1982 年出生，博士研究生。主要研究方向为机器人学和空间机器人技术。 [8] SAKATA H，NG T，MACK B. Collision avoidance E-mail：buptcg@gmail.com

分享到：

赞收藏

资料库

基于A_算法的空间机械臂避障路径规划_贾庆轩.pdf

相关推荐

开发技术

热门标签

最新资料