一种融合改进A*与改进DWA算法的运动规划方法技术

本发明专利技术公开了一种融合改进A*与改进DWA算法的运动规划方法，在路径规划方面，针对传统A*算法搜索效率低、拐点多、路径冗余的问题，提出了基于路径关键点提取的改进A*算法，扩展传统A*算法的搜索邻域，改进传统A*算法的启发函数，并提出一种路径关键点提取的方法。在轨迹规划方面，针对传统动态窗口法转向频繁和轨迹不平滑的问题，提出了基于目标评价函数优化的改进DWA算法，对该算法的评价函数进行优化，增加目标点距离评价函数，动态调节障碍物距离评价函数的系数。该方法可以提高路径规划的效率，减少无人车的运动时间，提高机器人避障的稳定性。稳定性。稳定性。

【技术实现步骤摘要】
一种融合改进A*与改进DWA算法的运动规划方法


[0001]本专利技术属于智能无人车领域，具体涉及一种融合改进A*与改进DWA算法的运动规划方法。

技术介绍

[0002]近年来，随着信息技术的快速发展，人们的日常生活和工作都离不开智能化科技，人们逐渐进入快捷简便的智能化时代。无人车代替人工在工业生产、勘测搜寻、服务行业、物流产业等领域的应用逐渐成为主流。为了提高无人车在导航过程中的快速和稳定，提高路径规划的效率和轨迹规划的速度及稳定性非常重要，因此提出了一种融合改进A*与改进DWA算法的运动规划方法。

技术实现思路

[0003]本专利技术的目的是提高无人车在导航过程中的快速和稳定。
[0004]为了解决上述技术问题，本专利技术专利的技术方案如下：一种融合改进A*与改进DWA算法的运动规划方法，该方法包括：
[0005]载入预定义的栅格地图；
[0006]基于无人车当前所处位置和所述栅格地图，确定目标点位置，结合改进的A*算法进行路径规划，生成初始路径节点；
[0007]基于上述生成的初始路径进行路径关键点提取，生成最终路径节点；
[0008]根据改进DWA算法生成最优的轨迹和速度，输出最优路径。
[0009]优选地，所述栅格地图分辨率为1m，栅格地图尺寸为a*b，其中a、b分别表示栅格地图中每行、每列的栅格的个数，其中，每个栅格表示一种区域，包括可行区域和不可行区域。
[0010]优选地，所述初始路径节点的规划过程包括：确定所述无人车所处当前位置与目标点，扩展传统A*算法的搜索邻域为16邻域，并将启发函数改为曼哈顿距离函数，生成代价函数值最小的无碰撞路径节点。
[0011]优选地，所述最终路径节点的规划过程包括：根据生成的初始路径节点，起始点加入关键节点序列，从起始点开始按顺序连接路径节点，直到连接的路径线段经过障碍物，那么选取该节点的上一个路径节点加入关键点序列，此路径节点作为新的起始点，继续与剩余的路径节点顺序相连，判断是否经过障碍物，直到找到目标点。生成的关键点序列就是最终路径节点。
[0012]优选地，所述改进DWA算法为在传统DWA算法评价函数中增加局部目标点评价函数，并根据局部目标点评价函数值的大小改进障碍物距离评价函数，该局部目标点为最终路径节点。通过改进的评价函数选择最优的轨迹和速度，输出最优路径。
[0013]优选地，所述的改进A*算法，所述的16邻域搜索为扩展当前栅格节点周围16个不同方向的栅格节点。
[0014]优选地，所述的改进A*算法，所述改进的A*算法函数包括：f(n)＝k1*g(n)+k2*h
(n)，其中，f(n)是扩展节点的代价值，g(n)是扩展节点与起始节点的实际距离，h(n)是扩展节点距离目标节点的估计距离，采用曼哈顿距离函数进行计算，k1、k2为不同代价函数的权重。
[0015]优选地，所述的改进A*算法，判断连接的两个路径节点是否经过障碍物的步骤包括：以开始节点的栅格中心为起点，以1/2栅格为步长选取连接线段上的点，当点既在横轴上又在纵轴上时，选段不占据任何栅格；当点在纵轴上时，线段占据该点左右两个栅格；当点在横轴上时，线段占据该点上下两个栅格；当点在栅格内部时，线段占据该栅格。根据线段占据的栅格里是否有障碍物栅格即可判断路径是否经过障碍物。
[0016]优选地，所述的改进DWA算法，所述局部目标点评价函数为goal_dist(v,w)，表示当前位置距离局部目标点的距离。所述改进的障碍物评价函数为dist(v,w)/((2
‑
goal_dist(v,w))/2)，dist(v,w)为传统的障碍物评价函数。
[0017]与现有技术相比较，本专利技术提出的一种无人车在遵循全局路径最优的同时快速朝目标点运动并且能够在动态环境中躲避障碍物的运动规划方法，该方法可以提高路径规划的效率，减少无人车的运动时间，提高机器人避障的稳定性。
附图说明
[0018]图1为本方法实施的流程图：
[0019]图2为邻域表示，(a)为八邻域，(b)为十六邻域。
[0020]图3为路径规划仿真对比：(a)为传统A*算法；(b)为基于关键点提取的改进A*。
[0021]图4融合算法导航仿真对比：
[0022](a)为传统DWA；(b)为基于目标评价函数的改进DWA；c
[0023]图5实物导航图：(a)为传统方法；(b)为本方法。
[0024]图6为关键点提取流程。
[0025]图7为硬件平台构成。
[0026]图8为实验框架。
[0027]图9为导航框架ros
‑
navigation。
具体实施方式
[0028]以下结合附图和实施例对本专利技术进行详细说明。
[0029]如图1所示，本专利技术是一种融合改进A*与改进DWA算法的运动规划方法。在路径规划方面，针对传统A*算法搜索效率低、拐点多、路径冗余的问题，提出了基于路径关键点提取的改进A*算法，扩展传统A*算法的搜索邻域，改进传统A*算法的启发函数，并提出一种路径关键点提取的方法。在轨迹规划方面，针对传统动态窗口法转向频繁和轨迹不平滑的问题，提出了基于目标评价函数优化的改进DWA算法，对该算法的评价函数进行优化，增加目标点距离评价函数，动态调节障碍物距离评价函数的系数。将改进后的A*算法与改进后的DWA算法进行融合，实现无人车的运动规划。
[0030]一种融合改进A*与改进DWA算法的运动规划方法，该方法包括：
[0031]载入预定义的栅格地图；
[0032]基于无人车当前所处位置和所述栅格地图，确定目标点位置，结合改进的A*算法
进行路径规划，生成初始路径节点；
[0033]基于上述生成的初始路径进行路径关键点提取，生成最终路径节点；
[0034]根据改进DWA算法生成最优的轨迹和速度，输出最优路径。
[0035]所述栅格地图分辨率为1m，栅格地图尺寸为a*b，其中a、b分别表示栅格地图中每行、每列的栅格的个数；每个栅格表示一种区域，包括可行区域和不可行区域。
[0036]所述初始路径节点的规划过程包括：确定所述无人车所处当前位置与目标点，扩展传统A*算法的搜索邻域为16邻域，并将启发函数改为曼哈顿距离函数，生成代价函数值最小的无碰撞路径节点。
[0037]所述最终路径节点的规划过程包括：根据生成的初始路径节点，起始点加入关键节点序列，从起始点开始按顺序连接路径节点，直到连接的路径线段经过障碍物，那么选取该节点的上一个路径节点加入关键点序列，此路径节点作为新的起始点，继续与剩余的路径节点顺序相连，判断是否经过障碍物，直到找到目标点；生成的关键点序列就是最终路径节点。
[0038]所述改进DWA算法为在传统DWA算法评价函数中增加局部目标点评价函数，并根据局部目标点评价函数值的大小改进障碍物距离评价函数，该局部目标点为最终路径节点；通过改进的评价函数本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种融合改进A*与改进DWA算法的运动规划方法，其特征在于，该方法包括：载入预定义的栅格地图；基于无人车当前所处位置和所述栅格地图，确定目标点位置，结合改进的A*算法进行路径规划，生成初始路径节点；基于上述生成的初始路径进行路径关键点提取，生成最终路径节点；根据改进DWA算法生成最优的轨迹和速度，输出最优路径。2.根据权利要求1所述的融合改进A*与改进DWA算法的运动规划方法，其特征在于，所述栅格地图分辨率为1m，栅格地图尺寸为a*b，其中a、b分别表示栅格地图中每行、每列的栅格的个数；每个栅格表示一种区域，包括可行区域和不可行区域。3.根据权利要求1所述的融合改进A*与改进DWA算法的运动规划方法，其特征在于，所述初始路径节点的规划过程包括：确定所述无人车所处当前位置与目标点，扩展传统A*算法的搜索邻域为16邻域，并将启发函数改为曼哈顿距离函数，生成代价函数值最小的无碰撞路径节点。4.根据权利要求1所述的融合改进A*与改进DWA算法的运动规划方法，其特征在于，所述最终路径节点的规划过程包括：根据生成的初始路径节点，起始点加入关键节点序列，从起始点开始按顺序连接路径节点，直到连接的路径线段经过障碍物，那么选取该节点的上一个路径节点加入关键点序列，此路径节点作为新的起始点，继续与剩余的路径节点顺序相连，判断是否经过障碍物，直到找到目标点；生成的关键点序列就是最终路径节点。5.根据权利要求1所述的融合改进A*与改进DWA算法的运动规划方法，其特征在于，所述改进DWA算法为在传统DWA算法评价函数中增加局部目标点评价函数，并根据局部目标...

【专利技术属性】
技术研发人员：刘梦茜，
申请(专利权)人：北京化工大学，
类型：发明
国别省市：