密集障碍物环境下移动机器人全局路径的规划.docVIP

密集障碍物环境下移动机器人全局路径规划 路径规划/双层粒子群/启发式搜索/脱障算子 1? 引言路径规划是机器人导航技术的重要部分,研究的内容是在已知或未知的环境中,寻找一条从起点到终点的满足一定优化指标的无碰撞路径。据机器人对环境的掌握状况,已有的路径规划方法可分为基于模型的全局路径规划和基于信息检测的局部路径规划。全局路径规划的基本问题是环境建模和路径寻优,重点在于开发高性能的搜索算法,使得规划的路径全局最优。目前,用于全局路径规划的方法主要有基于图论、栅格等的传统方法[1]和基于进化算法的智能方法[2]。这些方法各具优点,但又都有不足之处[3]。粒子群优化是Kennedy等借鉴鸟群的集体捕食行为,提出的一种随机群进化方法[4]。相对传统的优化方法,该方法易于实现、可调参数少,以及收敛速度快,已成功应用于函数优化、模式识别、神经网络训练、数据挖掘,以及路径规划等领域。但是,利用粒子群优化进行机器人路径规划,存在局部收敛、效率低下,以及精度不高等缺点,尤其是含有非规则密集障碍物的复杂环境,优化的路径多与障碍物碰撞。针对粒子群优化用于密集障碍物环境机器人全局路径规划存在的问题,本文提出一种双层微粒群优化方法(Two-layer particle swarm optimization, LPSO)。首先,采用坐标变换法构建环境模型,将路径规划问题表达为一个约束优化函数问题;接着,通过在评价函数中引入罚函数,将约束优化转变为无约束优化;随后,定义脱障算子,给出双层粒子群优化算法的思想及步骤;最后,仿真验证本文所提算法的有效性。 2? 问题描述与建模为了规划机器人路径,首先需要建立问题的数学模型。如图1所示,在机器人工作空间建立两维绝对坐标系,其中,S为机器人的起点,G为终点,多边形物体表示障碍物。当起点与终点的连线与X轴不重合时,建立如下相对坐标系S-xy:以S和G间的连线为轴,过S点且垂直SG的直线为y轴[5]。两坐标系间的变换公式为: 式中,(X,Y)和(x,y)分别为点在坐标系O-XY和S-xy的坐标,为坐标轴X与x的夹角,为S在坐标系O-XY的坐标。对线段SG进行D+1等分,并过每个等分点作SG的垂线,可以得到平行直线族,该直线族与路径的交点,即为规划的目标点序列机器人路径规划,就是在相对坐标系S-xy中,寻找一个目标点序列,使得构成的路径满足期望的性能指标。这里,对点的约束是:不在障碍物上或内部,且与相邻点的连线也不与障碍物相交。对于路径相对坐标为 机器人路径规划问题,可以建模为一个约束优化问题,通过惩罚不可行路径,得到如下无约束优化问题:式中,与障碍物碰撞的次数。由式(5)可知,P与障碍物碰撞的次数越多,受到的惩罚程度越大,该路径的性能越差。3? 基于双层粒子群优化算法的机器人全局路径规划3.1? 启发式搜索——脱障算子采用微粒群优化进行机器人路径规划时,如果能够根据机器人的起点和终点位置,以及障碍物的位置,引导微粒的搜索,那么,将会提高优化解成为可行路径的概率。基于此,当某路径不可行时,说明该路径的某段与障碍物相交,对该路径实施脱障操作,也即对微粒的相应分量定向定步长变异,以避免机器人与障碍物碰撞。图2给出了脱障操作的过程,图中,Ⅰ线为原来的路径,由于与障碍物相交,因此,是不可行的;Ⅱ线为脱障操作后得到的路径,不再与障碍物相交,从而成为可行路径。 需要注意的是,对微粒实施脱障操作后,如果微粒的某维,如,超出了取值范围,那么,采用下式进一步调整:3.2? 双层粒子群优化算法在复杂、密集障碍物的环境中,采用粒子群优化算法进行机器人全局路径规划时所得结果大多为非可行路径,既使为可行路径,也多为局部最优的;而调整粒子群优化算法的参数,已不能有效解决算法后期早熟收敛的问题。为此,本文基于算法结构,提出一种双层粒子群优化算法。该算法包括两层,底层粒子群优化算法主要在决策变量的取值空间中执行全局搜索,并采用脱障算子动态调整其全局极值点,以快速定位最优路径的大致位置。循环运行若干次底层算法、快速获取若干条无碰路径后,将其上传到顶层,作为顶层种群的部分粒子,进而为顶层算法确定重点搜索区域。为提高底层算法的全局搜索能力,本文采用基于线性递减惯性权值的更新公式更新粒子的速度和位置,具体更新公式如下:顶层粒子群优化算法接收底层搜索的若干条较优路径后进行局部搜索,并采用脱障算子动态扰动调整其全局极值点。为克服早熟收敛,顶层算法在初期仍需具有好的全局搜索能力。为此,在迭代过程中,顶层算法的惯性权重和个体学习因子采用线性递减方式,社会学习因子值采用线性递增。具体公式如下:3.3? 算法步骤基于双层粒子群优化算法的机器人全局路径规划方法可描述如下:Step1:由第2节所提方法,建立问题的环境地