一种移动机器人的路径规划方法技术

本发明专利技术公开了一种移动机器人的路径规划方法，具体按照以下步骤实施：步骤1，在基本RRT算法基础上采用一种目标偏向采样策略，提前设定一个目标偏向概率阈值pgoal；步骤2，在自由空间进行随机采样时根据均匀概率分布随机获得一个概率值p，将p与pgoal的取值进行比较，进而获得随机采样节点qrand的取值；步骤3，获得qrand之后，应用度量函数在RRT树中寻找能使到qrand之间的度量函数值最小的点qnear；步骤4，以qnear为起点向qrand方向移动距离Lstep,从而产生新节点记作qnew，然后检测qnew是否属于自由空间点；步骤5，循环以上操作直到qrand到达误差允许的目标点区域；步骤6，从目标状态点出发，依次反向搜索找到父节点，最终得到初步规划路径。本发明专利技术方法能够提高规划过程的实时性并大幅度光滑路径。

【技术实现步骤摘要】
一种移动机器人的路径规划方法
本专利技术属于移动机器人
，具体涉及一种移动机器人的路径规划方法。
技术介绍
随着生产、生活中对自动化越来越高的要求，智能机器人毋庸置疑是机器人技术发展的主流趋势。因此，机器人路径规划作为智能移动机器人研究的核心内容之一,在近几年的科研和生产中一直处于热点问题。所谓移动机器人路径规划,就是机器人根据自身传感器对环境的感知,根据特定算法自行规划出一条安全的运行路线,同时力求高效的完成作业任务。移动机器人路径规划主要解决3个问题：1)使机器人能从初始点运动到目标点；2)用一定的算法使机器人能绕开障碍物,并且经过某些特定点完成相应的作业任务；3)在完成以上任务的前提下,尽量优化机器人运行轨迹。移动机器人路径规划算法经过几十年的研究和发展，由最初的传统规划算法到基于人工智能的启发式规划算法，取得了大量研究成果。传统的算法包括基于采样的方法，比如随机路线图法(probabilisticroad-map，简称PRM))和快速搜索随机树法(rapidly-exploringrandomtrees，简称RRT)；基于图搜索的方法,如A*算法(A-Star)、D*算法(D-Star,或DynamicA-Star)；以及人工势场法。然而，由于传统方法存对环境模型严重依赖，对环境精确信息要求严格且易陷入局部极小值等缺点，往往不能得到最优的规划路径。因此，基于人工智能方法的启发式算法不断被提出并逐渐流行，比如遗传算法、蚁群算法、粒子群算法以及人工神经网络和模糊逻辑不断被用于移动机器人路径规划中并取得不错的效果。其中神经网络因其良好的非线性映射能力在路径规划中表现突出。启发式算法具有对非确定环境较强的自适应能力，因此克服了传统算法的缺陷，但因为计算量大，所以实时性较差，然而随着硬件计算能力的显著提升，该弊端也逐渐淡化。考虑到在众多传统规划算法中，由于RRT算法采用随机采样的规划方法，不需要对状态空间进行预处理，搜索速度快，而且在搜索的过程中还考虑了机器人客观存在的约束(非完整性约束、动力学约束、运动学约束)，从而能够有效地解决复杂环境下的运动规划问题，使得该算法近年来在机器人运动规划领域得到了广泛的应用和研究。但是其本身也存在诸如收敛速度慢，实时性差，算法的随机性导致其生成的路径不平滑，无法被非完整性约束机器人直接执行等缺点。因此，本专利技术文针对上述存在的问题，提出一种基于改进的RRT的运动规划算法，它采用了目标偏向采样策略和基于合理度量函数的节点连接机制来解决现有RRT算法在这方面的不足.通过仿真实验证实了该算法的优越性、有效性和实用性。
技术实现思路
本专利技术的目的是提供一种移动机器人的路径规划方法，该方法能够提高规划过程的实时性并大幅度光滑路径，获得实用的规划路径。本专利技术所采用的技术方案是，一种移动机器人的路径规划方法，具体按照以下步骤实施：步骤1，在基本RRT算法基础上采用一种目标偏向采样策略，提前设定一个目标偏向概率阈值pgoal；步骤2，在自由空间进行随机采样时根据均匀概率分布随机获得一个概率值p，将p与pgoal的取值进行比较，进而获得随机采样节点qrand的取值；步骤3，获得qrand之后，应用度量函数在RRT树中寻找能使到qrand之间的度量函数值最小的点qnear；步骤4，以qnear为起点向qrand方向移动距离Lstep,从而产生新节点记作qnew，然后检测qnew是否属于自由空间点，如果是，则将其加入RRT树，否则回到步骤2；步骤5，循环以上操作直到qrand到达误差允许的目标点区域，即满足|qrand-qgoal|≤ε，其中ε是允许的最大距离误差；步骤6，从目标状态点出发,依次反向搜索找到父节点，直至到达起始状态点，最终得到初步规划路径。本专利技术的特点还在于，步骤2中，qrand的取值遵循的原则为：如果p>pgoal，则qrand根据随机采样获得，否则qrand＝qgoal。度量函数为：C(qm,qn)＝w1.D(qm,qn)+w2.H(qm,qn)(1)式(1)中的D(qm,qn)表示qm，qn两节点间的欧氏距离经过归一化处理后的值；H(qm,qn)表示qm，qn两节点间的夹角经过归一化处理后的值，w1，w2分别为D(qm,qn)，H(qm,qn)的系数，且满足w1+w2＝1。式(1)中其中，是距离对应的归一化函数，d表示距离，dmax表示距离中的最大者；xm，ym分别表示qm点的x,y坐标，xn，yn分别表示qn点的x,y坐标。式(1)中H(qm,qn)＝N2(|θm-θn|)，其中，是角度对应的归一化函数，θ表示角度，θmax表示角度值中最大者。本专利技术的有益效果是该方法能够提高规划过程的实时性并大幅度光滑路径，获得实用的规划路径。附图说明图1是应用本专利技术方法基于同时兼顾距离和夹角所提出的新的度量函数下新增点选择策略图。具体实施方式下面结合附图和具体实施方式对本专利技术进行详细说明。本专利技术为一种移动机器人的路径规划方法，如图1所示，具体按照以下步骤实施：步骤1，在基本RRT算法基础上采用一种目标偏向采样策略，提前设定一个目标偏向概率阈值pgoal；步骤2，在自由空间进行随机采样时根据均匀概率分布随机获得一个概率值p，将p与pgoal的取值进行比较，进而获得随机采样节点qrand的取值；步骤2中，qrand的取值遵循的原则为：如果p>pgoal，则qrand根据随机采样获得，否则qrand＝qgoal；步骤3，获得qrand之后，应用度量函数在RRT树中寻找能使到qrand之间的度量函数值最小的点qnear；步骤3中，所述度量函数为：C(qm,qn)＝w1.D(qm,qn)+w2.H(qm,qn)(1)式(1)中的D(qm,qn)表示qm，qn两节点间的欧氏距离经过归一化处理后的值；H(qm,qn)表示qm，qn两节点间的夹角经过归一化处理后的值，w1，w2分别为D(qm,qn)，H(qm,qn)的系数，且满足w1+w2＝1；式(1)中其中，是距离对应的归一化函数，d表示距离，dmax表示距离中的最大者；xm，ym分别表示qm点的x,y坐标，xn，yn分别表示qn点的x,y坐标；式(1)中H(qm,qn)＝N2(|θm-θn|)，其中，是角度对应的归一化函数，θ表示角度，θmax表示角度值中最大者；步骤4，以qnear为起点向qrand方向移动距离Lstep,从而产生新节点记作qnew，然后检测qnew是否属于自由空间点，如果是，则将其加入RRT树，否则回到步骤2；步骤5，循环以上操作直到qrand到达误差允许的目标点区域，即满足|qrand-qgoal|≤ε，其中ε是允许的最大距离误差，可根据具体需要调整；步骤6，从目标状态点出发,依次反向搜索找到父节点，直至到达起始状态点，最终得到初步规划路径。图1表示的是基于同时兼顾距离和夹角所提出的新的度量函数下新增点选择略，图中qm、qn为RRT树节点，qrand为生成的随机采样节点，qnear为根据度量函数选定的近邻节点(在图1中，qnear与qn是同一点)，qnew为新添加的树节点，Lstep为节点生成步长；d1,d2，分别代表qm，qn与qrand之间的距离，θ1，θ2分别代表qm，qn所本文档来自技高网...

【技术保护点】
一种移动机器人的路径规划方法，其特征在于，具体按照以下步骤实施：步骤1，在基本RRT算法基础上采用一种目标偏向采样策略，提前设定一个目标偏向概率阈值pgoal；步骤2，在自由空间进行随机采样时根据均匀概率分布随机获得一个概率值p，将p与pgoal的取值进行比较，进而获得随机采样节点qrand的取值；步骤3，获得qrand之后，应用度量函数在RRT树中寻找能使到qrand之间的度量函数值最小的点qnear；步骤4，以qnear为起点向qrand方向移动距离Lstep,从而产生新节点记作qnew，然后检测qnew是否属于自由空间点，如果是，则将其加入RRT树，否则回到步骤2；步骤5，循环以上操作直到qrand到达误差允许的目标点区域，即满足|qrand‑qgoal|≤ε，其中ε是允许的最大距离误差；步骤6，从目标状态点出发,依次反向搜索找到父节点，直至到达起始状态点，最终得到初步规划路径。

【技术特征摘要】
1.一种移动机器人的路径规划方法，其特征在于，具体按照以下步骤实施：步骤1，在基本RRT算法基础上采用一种目标偏向采样策略，提前设定一个目标偏向概率阈值pgoal；步骤2，在自由空间进行随机采样时根据均匀概率分布随机获得一个概率值p，将p与pgoal的取值进行比较，进而获得随机采样节点qrand的取值；步骤3，获得qrand之后，应用度量函数在RRT树中寻找能使到qrand之间的度量函数值最小的点qnear；步骤4，以qnear为起点向qrand方向移动距离Lstep,从而产生新节点记作qnew，然后检测qnew是否属于自由空间点，如果是，则将其加入RRT树，否则回到步骤2；步骤5，循环以上操作直到qrand到达误差允许的目标点区域，即满足|qrand-qgoal|≤ε，其中ε是允许的最大距离误差；步骤6，从目标状态点出发,依次反向搜索找到父节点，直至到达起始状态点，最终得到初步规划路径。2.根据权利要求1所述的一种移动机器人的路径规划方法，其特征在于，步骤2中，qrand的取值遵循的...

【专利技术属性】
技术研发人员：张鹏超，熊超，
申请(专利权)人：陕西理工大学，
类型：发明
国别省市：陕西,61