一种基于改进A-Star算法与DWA算法的动态环境路径规划方法及系统技术方案

本发明专利技术提供一种基于改进A

【技术实现步骤摘要】
一种基于改进A
‑
Star算法与DWA算法的动态环境路径规划方法及系统


[0001]本专利技术涉及动态路径规划
，具体而言，涉及一种基于改进A
‑
Star算法与DWA算法的动态环境路径规划方法及系统。

技术介绍

[0002]动态路径规划指的是在运行过程中对路径进行实时调整和优化，以应对环境变化和任务需求的变化。在仓储、物流等行业中，动态路径规划非常重要，因为它可以帮助机器人智能地适应快速变化的工作环境和任务，提高机器人的效率和灵活性。在实际工作中，仓库或生产线中的环境经常发生变化，例如货物堆放位置、道路阻塞等，需要根据实时情况对路径进行调整和优化，以尽可能避开障碍物和缩短路径。
[0003]当地图中存在动态障碍物时，地图中障碍物信息不能完全已知，A
‑
Star算法为全局路径规划算法，在进行路径规划时依赖已知的地图信息，故无法躲避动态障碍物。DWA算法为局部路径规划算法，在进行路径规划时会不断更新地图模型，避免与动态障碍物发生碰撞，但DWA算法容易陷入局部最小值，此时就会出现找不到路的情况。

技术实现思路

[0004]本专利技术要解决的技术问题是：
[0005]为了解决A
‑
Star算法无法躲避动态障碍物，DWA算法容易陷入局部最小值，会出现找不到路的情况，且缺乏二者有效融合的问题。
[0006]本专利技术为解决上述技术问题所采用的技术方案：
[0007]本专利技术提供了一种基于改进A
‑
Star算法与DWA算法的动态环境路径规划方法，包括以下步骤：
[0008]步骤一、采用改进A
‑
Star算法在只考虑静态障碍物的情况下规划出完整路径；
[0009]步骤二、给出机器人的初始状态C，包括横轴坐标、纵轴坐标、航向角、速度和角速度；
[0010]步骤三、判断当前轨迹的末端是否为路径终点，若当前轨迹末端未到达路径终点，则重复以下步骤，直至当前轨迹末端到达终点并跳转至步骤四，
[0011]①
通过机器人本身能达到的速度V
s
，与以当前速度和最大加速度在一定时间内能达到的速度V
d
，确定速度采样的窗口；
[0012]②
通过窗口中的最大速度、最小速度、最大角速度、最小角速度和速度分辨率、角速度分辨率确定能采样得到的速度；
[0013]③
以采样到的速度生成多条预测轨迹，通过轨迹末端的状态计算航向角偏差、距障碍物的最小距离、制动距离、速度大小及到改进A
‑
Star算法所规划路径的最短距离；
[0014]④
根据轨迹末端距障碍物的最小距离确定对其进行评价时速度采用的系数；
[0015]⑤
选择最优轨迹，将
③
中获取的航向角偏差、距障碍物的最小距离、制动距离、速
度大小及到改进A
‑
Star算法所规划路径的最短距离和
④
中的评价时速度采用的系数代入至评价函数中，计算得到评价函数中的评价函数值最大的路径作为最优轨迹，记录其对应的速度与角速度，更新机器人状态；
[0016]步骤四：将各段轨迹组合为完整的路径。
[0017]进一步地，在步骤一中，具体包括以下步骤：
[0018]①
、获取并输入起始点、目标节点和地图信息，将起始点添加进开放列表；
[0019]②
、获取路径，包括：
[0020]从起始点开始，即第一个当前节点为起始点，判断当前节点的相邻节点是否在开放列表中：若在，记录相邻节点中最小g值的节点，将当前节点作为该最小g值相邻节点的父节点；若不在，将该相邻节点加入开放列表并判断该相邻节点是否为目标节点，如果为目标节点，结束当前循环；如果不为目标节点，将当前节点作为该节点的父节点；
[0021](2)将(1)中得到的当前节点移入关闭列表；
[0022](3)采用改进的评价函数计算相邻节点的f值；
[0023](4)选择开放列表中f值最小的节点，作为下一当前节点；
[0024]当开放列表不为空时重复上述步骤，否则跳到
③
；
[0025]③
、若目标节点在关闭列表中，则从目标节点开始，沿着每一节点的父节点回溯到起始节点，保存路径；若目标节点不在关闭列表中，则无法找到路径；
[0026]④
、对路径点进行判断，若存在路径点与障碍物之间的最小距离小于最小安全距离则路径无效，否则保存路径，将保存的路径作为初次规划得到路径，最小安全距离定义为机器人中心到其最远边缘的距离；
[0027]⑤
：对初次规划得到路径进行再处理，在保证路径与障碍物之间的距离大于最小安全距离的情况下，去除路径中的第一类和第二类节点，得到最终路径。
[0028]进一步地，在步骤
②
(3)中，改进后的评价函数如式(1)所示，
[0029]f(n)＝g(n)+h(n)+5.1/o(n) (1)
[0030]o(n)的计算公式如式(2)和(3)所示：
[0031]o(n)＝min(dist) (2)
[0032][0033]其中，f(n)代表评价函数；g(n)为起始点到当前节点n的观测评估值；h(n)为当前节点n到终点的估计评估值；o(n)为当前节点n与障碍物之间的最小距离，dist为当前节点与障碍物之间的距离；(x
n
,y
n
)为当前节点n的坐标；(x
o
(i),y
o
(i))为第i个障碍物的坐标；i为障碍物的数量。
[0034]进一步地，在步骤三
④
中，改进后的评价函数的表达式如式(9)所示：
[0035][0036]其中，α、β和γ为加权系数；σ为归一化参数；heading(v,ω)为当前行驶方向与目标方向之间的夹角；dist(v,ω)为机器人轨迹距障碍物的最小距离；velocity(v,ω)为当前速度的大小；λ为参数；A为常数，表示路径点距改进A
‑
Star算法已规划出路径的最远距
离；distAstar(v,ω)为指定速度、角速度下当前节点与采样点之间的最小值；γ_fast和γ_slow均为评价函数中速度的系数。
[0037]进一步地，distAstar(v,ω)的表达式在式(10)和(11)中给出，
[0038][0039]distAstar(v,ω)＝min(dis)
ꢀꢀ
(11)
[0040]其中，当前路径点N的坐标为(N
x
,N
y
)；采样点Sample的坐标为(Samp
ix
,Samp
iy
)。
[0041]进一步地，dist(v,ω)的表达式如式(12)所示，
[00本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种基于改进A
‑
Star算法与DWA算法的动态环境路径规划方法，其特征在于，包括以下步骤：步骤一、采用改进A
‑
Star算法在只考虑静态障碍物的情况下规划出完整路径；步骤二、给出机器人的初始状态C，包括横轴坐标、纵轴坐标、航向角、速度和角速度；步骤三、判断当前轨迹的末端是否为路径终点，若当前轨迹末端未到达路径终点，则重复以下步骤，直至当前轨迹末端到达终点并跳转至步骤四，
①
通过机器人本身能达到的速度V
s
，与以当前速度和最大加速度在一定时间内能达到的速度V
d
，确定速度采样的窗口；
②
通过窗口中的最大速度、最小速度、最大角速度、最小角速度和速度分辨率、角速度分辨率确定能采样得到的速度；
③
以采样到的速度生成多条预测轨迹，通过轨迹末端的状态计算航向角偏差、距障碍物的最小距离、制动距离、速度大小及到改进A
‑
Star算法所规划路径的最短距离；
④
根据轨迹末端距障碍物的最小距离确定对其进行评价时速度采用的系数；
⑤
选择最优轨迹，将
③
中获取的航向角偏差、距障碍物的最小距离、制动距离、速度大小及到改进A
‑
Star算法所规划路径的最短距离和
④
中的评价时速度采用的系数代入至评价函数中，计算得到评价函数中的评价函数值最大的路径作为最优轨迹，记录其对应的速度与角速度，更新机器人状态；步骤四：将各段轨迹组合为完整的路径。2.根据权利要求1所述的一种基于改进A
‑
Star算法与DWA算法的动态环境路径规划方法，其特征在于，在步骤一中，具体包括以下步骤：
①
、获取并输入起始点、目标节点和地图信息，将起始点添加进开放列表；
②
、获取路径，包括：从起始点开始，即第一个当前节点为起始点，判断当前节点的相邻节点是否在开放列表中：若在，记录相邻节点中最小g值的节点，将当前节点作为该最小g值相邻节点的父节点；若不在，将该相邻节点加入开放列表并判断该相邻节点是否为目标节点，如果为目标节点，结束当前循环；如果不为目标节点，将当前节点作为该节点的父节点；(2)将(1)中得到的当前节点移入关闭列表；(3)采用改进的评价函数计算相邻节点的f值；(4)选择开放列表中f值最小的节点，作为下一当前节点；当开放列表不为空时重复上述步骤，否则跳到
③
；
③
、若目标节点在关闭列表中，则从目标节点开始，沿着每一节点的父节点回溯到起始节点，保存路径；若目标节点不在关闭列表中，则无法找到路径；
④
、对路径点进行判断，若存在路径点与障碍物之间的最小距离小于最小安全距离则路径无效，否则保存路径，将保存的路径作为初次规划得到路径，最小安全距离定义为机器人中心到其最远边缘的距离；
⑤
：对初次规划得到路径进行再处理，在保证路径与障碍物之间的距离大于最小安全距离的情况下，去除路径中的第一类和第二类节点，得到最终路径。3.根据权利要求2所述的一种基于改进A
‑
Star算法与DWA算法的动态环境路径规划方法，其特征在于：在步骤
②
(3)中，改进后的评价函数如式(1)所示，
f(n)＝g(n)+h(n)+5.1/o(n)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(1)o(n)的计算公式如式(2)和(3)所示：o(n)＝min(dist)
ꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀꢀ
(2)其中，f(n)代表评价函数；g(n)为起始点到当前节点n的观测评估值；h(n)为当前节点n到终点的估计评估值；o(n)为当前节点n与障碍物之间的最小距离，dist为当前节点与障碍物之间的距离；(x
n
,y
n
)为当前节点n的坐标；(x
o
(i),y
o
(i))为第i个障碍物的坐标；i为障碍物的数量。4.根据权利要求3所述的一...

【专利技术属性】
技术研发人员：焉晓贞，周新悦，罗清华，丁若晨，周志权，贾广乐，王晨旭，
申请(专利权)人：哈尔滨工业大学威海，
类型：发明
国别省市：