一种越野环境下基于改进的A*算法的路径规划方法

一种越野环境下基于改进的a*算法的路径规划方法
技术领域
1.本发明属于路径规划技术领域，具体涉及越野环境下基于改进的a*算法的路径规划方法。


背景技术：

2.路径规划技术大致可以分为以下：基于最优算法智能搜索法，经典的有蚁群算法、粒子群算法、遗传算法、概率路线图和快速探索随机树算法等。基于几何模型的路径规划方法，其经典规划算法包括dijkstra算法、a*算法、d*算法、field d*算法等，其中hybrid a*算法在非结构化道路环境下智能车路径规划中有着很好的效果。还有用于局部避障的算法，包括人工势场法和动态窗口方法。然而传统的路径规划算法在复杂的场景的表现并不如人意，例如复杂的越野环境。因此，针对越野场景的路径规划，有方法通过采集地形信息进行随机采样路径规划，然而规划的路径拐点太多。还有采用自适应变异遗传算法，建立优化搜索速度和方位的模型，在连续空间内进行路径规划，然而此类算法容易陷入局部最优点的问题。另一种方法提出了改进的a*算法，在地形坡度和地表属性的综合影响下，利用窗口移动法来提高搜索效率，然而该方法只针对越野环境进行建模，未对算法本身进行改进，使得算法效率低下。还有人提出了基于势能场模型的概率图算法，通过人工势场法对环境进行建模，利用概率图算法进行路径规划，缺点是未对人工势场进行改进，此类方法容易陷入局部最小值；
3.因此需要提出一种越野环境下基于改进的a*算法的路径规划方法，以解决上述问题。


技术实现要素：

4.有鉴于此，本发明的目的在于提供一种越野环境下基于改进的a*算法的路径规划方法，用于解决现有技术中，路径规划所采用的传统算法，路径拐点太多、容易陷入局部最优点的问题、算法效率低下等问题。
5.为达到上述目的，本发明提供如下技术方案：
6.本发明提供一种越野环境下基于改进的a*算法的路径规划方法，包括以下步骤：
7.a1：将智能车辆的工作空间划分成大小相同的栅格，采用数值矩阵来储存环境信息，通过建立障碍物模型威胁模型和道路模型并融合得到最终的越野环境模型
[0008][0009]
其中，障碍物模型，为威胁模型，为道路模型；
[0010]
a2：分析子节点与障碍物的位置关系，建立子节点的选择区域(i,j)；
[0011]
a3：在子节点区域中引入方向变化惩罚规则并通过量化局部区域的信息建立所述越野环境下的评估函数：
[0012]
f(n)＝r
t
(g(n
父
)+η*step)+ro(h(n))
[0013][0014][0015]
其中，f(n)为全局评估函数，g(n
父
)为节点n父节点的真实代价值，d_p为方向变化惩罚，step为移动代价，为在节点坐标(i,j)越野栅格地图值，h(n)为节点n的预估代价，ε为环境威胁敏感度，d
nt
为节点到目标点的距离，d
st
起始点到目标点的距离；r
t
和ro是自适应调节系数，qo和q
t
为威胁率和通过率，η为调节系数；
[0016]
a4：设置防碰撞安全距离d实现路径优化，保证所述安全距离d与威胁物的距离l满足l≥d：
[0017][0018]
其中，d为安全距离，为在节点坐标(i,j)越野栅格地图值，celld为单元栅格的长度。
[0019]
进一步，步骤a1所述的障碍物模型表示为：
[0020][0021][0022]
其中，障碍物模型，o障碍物区域，(x
ij
,y
ij
)为越野栅格模型的坐标点，r和c是所设置地图大小的长和宽,m
ij
是地图上的每个栅格上数值；
[0023]
所述威胁模型表示为：
[0024][0025][0026]
其中，为威胁模型，t为威胁物，z为威胁等级，r为威胁范围半径，r和c是所设置地图大小的长和宽,m
ij
是地图上的每个栅格上数值；
[0027]
所述道路模型表示为：
[0028][0029][0030]
其中，为道路模型，h越野道路，k为道路通行系数,r和c是所设置地图大小的长
和宽，m
ij
是地图上的每个栅格上数值。
[0031]
进一步，步骤a2中所述子节点的选择区域需通过以下规则进行：
[0032]
relu1：若子节点4或子节点12具有威胁(在越野环境栅格地图中值≥1)，则子节点2、子节点6、子节点4、子节点5或子节点13、子节点9、子节点14、子节点11不作为预选点。
[0033]
rule2：若子节点16或子节点8具有威胁，则子节点2、子节点13、子节点15、子节点1或子节点6、子节点9、子节点10、子节点7不作为预选点。
[0034]
rule3：均无具威胁，则不做处理。
[0035]
进一步，步骤a3中所述越野环境下的评估函数的设计包括以下步骤：
[0036]
c1：引入方向惩罚规则：计算当前节点与该其父节点的方向direction1和当前节点到其子节点的方向direction2，计算方向变化d_change＝|direction1-direction2|，若d_change》4，则将方向变化惩罚d_p置为无穷大，若d_change≤4，则选择相应的方向变化惩罚系数；
[0037]
c2：通过量化局部区域信息判断是否存在障碍物，若有障碍物，则根据威胁率qo寻找更优路径；若无障碍物，则根据通过率q
t
缩小搜索范围。
[0038]
c3：将得到的方向变化惩罚d_p、局部区域的威胁率qo和通过率q
t
，在越野环境下代入评估函数计算。
[0039]
进一步，所述步骤a4中，保证所述安全距离d与威胁物的距离l满足l≥d，具体步骤为：
[0040]
d1：设置s为起始点，s坐标为(xs,ys)，正向floyd算法，从起始点s开始，按步长k取下一路径点1，计算距离l与安全距离d并判断小大，若满足l≥d则取下一路径点2，直至存在不满足l≥d的路径点n，则重新设置点n-1为开始点，继续取点循环以上步骤直至遇到终点t循环结束；
[0041]
d2：反向floyd算法，将终点t设置为起始点，按t
→
s的方向遍历所述d1中的路径点直至遇见起始点s循环结束；
[0042]
d3：若正向floyd算法优化路径与反向floyd算法优化路径存在交点，则取交点作为路径拐点；若不存在交点，则取拐点数与路径长度和小的路径。
[0043]
进一步，步骤c2所述的威胁率qo和通过率q
t
通过以下公式计算：
[0044][0045][0046]
其中，qo为威胁率，q
t
为通过率，lo为局部区域，越野环境栅格地图值，δ
t
为环境敏感度，考虑到越野智能车辆，对于草地土路能够轻松驶过，设置为0.5，可根据车辆类型工作任务灵活选取。n
l
,nd为越野栅格地图中一行和一列均小于δ
t
的条数，l和d为局部区域的行和列。
[0047]
如上所述，本发明的越野环境下基于改进的a*算法的路径规划方法，具有以下有益效果：本发明采用栅格法建立模拟了真实的越野环境场景，通过对越野环境中的障碍物、威胁物和越野道路进行层次化建模，能够融合多层次地图，实现对越野环境的真实模拟，有利于在真实场景下对越野车进行路径规划；引入方向变化惩罚，来控制规划路径的平滑度，
使得规划的路径更为笔直；设计局部区域复杂度惩罚，自适应控制算法的搜索空间，使得算法更为智能高效；改进的a*算法能够在越野环境中多中因素的综合影响，以及不同车辆性能和任务的要求下，能够快速的规划出安全、笔直和高效的优化路径。
[0048]
本发明的其他优点、目标和特征将在随后的说明书中进行阐述，并且在某种程度上对本领域技术人员而言是显而易见的，或者本领域技术人员可以从本发明的实践中得到教导。本发明的目标和其他优点可以通过下面的说明书来实现和获得。
附图说明
[0049]
为了使本发明的目的、技术方案和有益效果更加清楚，本发明提供如下附图进行说明：
[0050]
图1为本发明的流程图；
[0051]
图2为本发明的子节点细节图；
[0052]
图3为本发明的子节点图；
[0053]
图4为本明的方向变化惩罚定义示意图；
[0054]
图5为本明的局部区域复杂度定义示意图；
[0055]
图6为本发明的双向floyd算法示意图。
具体实施方式
[0056]
请参阅图1至图6，发明提供一种越野环境下基于改进的a*算法的路径规划方法，包括以下步骤：a1：将智能车辆的工作空间划分成大小相同的栅格，采用数值矩阵来储存环境信息，通过建立障碍物模型威胁模型和道路模型并融合得到最终的越野环境模型
[0057][0058]
其中，障碍物模型，为威胁模型，为道路模型；
[0059]
a2：分析子节点与障碍物的位置关系，建立子节点的选择区域(i,j)；
[0060]
a3：在子节点区域中引入方向变化惩罚规则并通过量化局部区域的信息建立所述越野环境下的评估函数：
[0061]
f(n)＝r
t
(g(n
父
)+η*step)+ro(h(n))
[0062][0063][0064]
其中，f(n)为全局评估函数，g(n
父
)为节点n父节点的真实代价值，d_p为方向变化惩罚，step为移动代价，为在节点坐标(i,j)越野栅格地图值，h(n)为节点n的预估代价，ε为环境威胁敏感度，d
nt
为节点到目标点的距离，d
st
起始点到目标点的距离；r
t
和ro是自适应调节系数，qo和q
t
为威胁率和通过率，η为调节系数；
[0065]
a4：设置防碰撞安全距离d实现路径优化，保证所述安全距离d与威胁物的距离l满足l≥d：
[0066][0067]
其中，d为安全距离，为在节点坐标(i,j)越野栅格地图值，celld为单元栅格的长度。
[0068]
上述技术方案的工作原理：首先深入研究真实越野环境，采用栅格法将智能车辆的工作空间划分成大小相同的栅格，采用数值矩阵来储存环境信息，通过建立障碍模型、威胁模型和越野道路模型，融合三个层次模型来真实模型越野场景；然后分析子节点与障碍物的位置关系，建立子节点的选择区域，在子节点区域中引入方向变化惩罚和局部区域环境特征惩罚对a*算法的全局评估函数进行改进；最后设置防碰撞安全距离d实现路径优化。
[0069]
上述技术方案的有益效果：采用栅格法建立模拟了真实的越野环境场景，通过对越野环境中的障碍物、威胁物和越野道路进行层次化建模，能够融合多层次地图，实现对越野环境的真实模拟，有利于在真实场景下对越野车进行路径规划；引入方向变化惩罚，来控制规划路径的平滑度，使得规划的路径更为笔直；设计局部区域复杂度惩罚，自适应控制算法的搜索空间，使得算法更为智能高效。
[0070]
在本发明的一个实施例中，步骤a1所述的障碍物模型表示为：
[0071][0072][0073]
其中，障碍物模型，o障碍物区域，(x
ij
,y
ij
)为越野栅格模型的坐标点，r和c是所设置地图大小的长和宽,m
ij
是地图上的每个栅格上数值；
[0074]
所述威胁模型表示为：
[0075][0076][0077]
其中，为威胁模型，t为威胁物，z为威胁等级，r为威胁范围半径，r和c是所设置地图大小的长和宽,m
ij
是地图上的每个栅格上数值；
[0078]
所述道路模型表示为：
[0079][0080][0081]
其中，为道路模型，h越野道路，k为道路通行系数,r和c是所设置地图大小的长
和宽，m
ij
是地图上的每个栅格上数值。
[0082]
上述技术方案的工作原理：障碍物模型即为越野环境中智能车辆无法驶过的区域，如建筑物、森林、山地等；威胁模型指的是越野环境中可能对智能车造成破坏损伤的存在，如地雷和敌军等；道路模型即为越野环境中智能车辆可安全行驶的区域，在越野环境中，可行驶区域大致可分为：硬质路面、土路、草地和沙地等。根据如表1提出的现有的地表属性与道路通行系数代入道路模型中计算，本发明采用栅格法将智能车辆的工作空间划分成大小相同的栅格，采用数值矩阵来储存环境信息，通过建立障碍模型、威胁模型和越野道路模型，融合三个层次模型来真实模型越野场景；值得注意的是，三个模型的优先级为：威胁模型、障碍物模型、道路模型，当融合模型重叠时，优先考虑优先级高的模型以及模型数据值高的栅格。
[0083]
表1 地表属性与道路通行系数
[0084][0085]
上述技术方案的有益效果：将越野环境中的障碍物、威胁物和越野道路进行层次化建模，能够融合多层次地图，实现对越野环境的真实模拟，有利于在真实场景下对越野车进行路径规划。
[0086]
在本发明的一个实施例中，步骤a2中所述子节点的选择区域需通过以下规则进行：
[0087]
relu1：若子节点4或子节点12具有威胁(在越野环境栅格地图中值≥1)，则子节点2、子节点6、子节点4、子节点5或子节点13、子节点9、子节点14、子节点11不作为预选点。
[0088]
rule2：若子节点16或子节点8具有威胁，则子节点2、子节点13、子节点15、子节点1或子节点6、子节点9、子节点10、子节点7不作为预选点。
[0089]
rule3：均无具威胁，则不做处理。
[0090]
上述技术方案的工作原理：为了找到从起始点到终点的路径，需定义一种可以选择后续节点的方式。考虑到在复杂越野环境上，我们希望智能车辆允许更多的自由运动来更好规避危险，选择16-邻接(见图2)。在传统的子节点选择上，只考虑了子节点是否存在障碍物，而没有考虑子节点与障碍物的位置关系，则规划的路径存在斜着经过障碍物栅格顶点，可能发碰撞可能。如图3，为16个子节点分布图，设计的子节点选择规则为：relu1：若子节点4或子节点12具有威胁(在越野环境栅格地图中值≥1)，则子节点2、子节点6、子节点4、子节点5或子节点13、子节点9、子节点14、子节点11不作为预选点；rule2：若子节点16或子节点8具有威胁，则子节点2、子节点13、子节点15、子节点1或子节点6、子节点9、子节点10、子节点7不作为预选点；rule3：均无具威胁，则不做处理。
[0091]
上述技术方案的有益效果：在复杂的越野环境下，考虑子节点与障碍物的位置关
系，避免在规划的路径中出现斜着经过障碍物栅格顶点，导致发生碰撞的现象；设计一种子节点的选择规则，能够使智能车辆有效规避危险，达到安全高效的目的。
[0092]
在本发明的一个实施例中，步骤a3中所述越野环境下的评估函数的设计包括以下步骤：
[0093]
c1：引入方向惩罚规则：计算当前节点与该其父节点的方向direction1和当前节点到其子节点的方向direction2，计算方向变化d_change＝|direction1-direction2|，若d_change》4，则将方向变化惩罚d_p置为无穷大，若d_change≤4，则选择相应的方向变化惩罚系数；
[0094]
c2：通过量化局部区域信息判断是否存在障碍物，若有障碍物，则根据威胁率qo寻找更优路径；若无障碍物，则根据通过率q
t
缩小搜索范围。
[0095]
c3：将得到的方向变化惩罚d_p、局部区域的威胁率qo和通过率q
t
，在越野环境下代入评估函数计算。
[0096]
上述技术方案的工作原理：本发明引入方向变化惩罚，来减少路径的无用拐点。规定智能车的转弯角度范围为0
°‑
90
°
，方向变化惩罚规则为：step1：计算当前节点与该其父节点的方向direction1，方向规定如图4(a)所示；step2：计算当前节点到其子节点的方向direction2。step3：计算方向变化"d_change＝"|"direction1-direction2"|，若"d_change》4"，则将方向变化惩罚d_p置为无穷大，若"d_change≤"4，则参考表2选择相应的方向变化惩罚系数。
[0097]
表2 方向变化惩罚系数参照表
[0098]
方向变化(d_change)方向变化惩罚系数(d_p)01.011.221.431.641.8
[0099]
上述技术方案的有益效果：引入方向变化惩罚，来控制规划路径的平滑度，使得规划的路径更为笔直、更少转弯和转弯的角度应小点；设计局部区域复杂度惩罚，自适应控制算法的搜索空间，使得算法更为智能高效。
[0100]
在本发明的一个实施例中，所述步骤a4中，保证所述安全距离d与威胁物的距离l满足l≥d，具体步骤为：
[0101]
d1：设置s为起始点，s坐标为(xs,ys)，正向floyd算法，从起始点s开始，按步长k取下一路径点1，计算距离l与安全距离d并判断小大，若满足l≥d则取下一路径点2，直至存在不满足l≥d的路径点n，则重新设置点n-1为开始点，继续取点循环以上步骤直至遇到终点t循环结束；
[0102]
d2：反向floyd算法，将终点t设置为起始点，按t
→
s的方向遍历所述d1中的路径点直至遇见起始点s循环结束；
[0103]
d3：若正向floyd算法优化路径与反向floyd算法优化路径存在交点，则取交点作为路径拐点；若不存在交点，则取拐点数与路径长度和小的路径。
[0104]
上述技术方案的工作原理：通过威胁物点到连线的垂直距离l与设置的安全距离d
的关系，判断优化的路径是否安全。如图6所示，设点a坐标为(xa,ya)，点s坐标为(xs,ys)，点n3的坐标为(x
n3
,y
n3
)，则可以计算得到点a距离直线s-n的距离l；优化的路径要保证距离威胁物的距离要满足。具体步骤为：step1：从起始点s开始，设置s为开始点，按步长k取下一路径点1，计算距离l与安全距离d并判断小大，若满足则取下一路径点2，直至存在不满足l≥d的路径点n，则重新设置点n-1为开始点，继续取点循环以上步骤直至遇到终点t循环结束；step2：反向floyd算法，将终点t设置为开始点，按step1反向遍历路径点直至遇见起始点s循环结束；step3：若正向floyd算法优化路径与反向floyd算法优化路径存在交点，则取交点作为路径拐点；若不存在交点，则于拐点数与路径长度和小的路径。
[0105]
上述技术方案的有益效果：改进的floyd算法，设计了双向优化处理来实现双向平滑优化；设计了安全距离，来保证优化了路径避免与障碍物威胁物等发生碰撞；保证距离威胁物的距离满足l≥d，得到更优化的路径，使得智能车辆在行驶过程中更加安全。
[0106]
在本发明的一个实施例中，步骤c2所述的威胁率qo和通过率q
t
通过以下公式计算：
[0107][0108][0109]
其中，qo为威胁率，q
t
为通过率，lo为局部区域，越野环境栅格地图值，δ
t
为环境敏感度，考虑到越野智能车辆，对于草地土路能够轻松驶过，设置为0.5，可根据车辆类型工作任务灵活选取。n
l
,nd为越野栅格地图中一行和一列均小于δ
t
的条数，l和d为局部区域的行和列。
[0110]
上述技术方案的工作原理和有益效果：通过公式计算威胁率qo和通过率q
t
，根据局部区域复杂度，来自适应调节节点的搜索空间，降低算法的时间复杂度。如图5(a)所示，若此时当前节点为节点1，它的父节点为父节点1，则可计算得到当前的方向为3，参考图5(b)可获得该方位上的局部区域，观察图5(a)局部区域，明显此区域存在障碍物、威胁物和草地等，在此区域内，希望算法能够扩大搜索范围，寻找更优路径在避免接触障碍物和威胁物；相反如果该区域不存在障碍物和威胁物体，则希望算法能够缩小搜索范围，提高效率。
[0111]
最后说明的是，以上优选实施例仅用以说明本发明的技术方案而非限制，尽管通过上述优选实施例已经对本发明进行了详细的描述，但本领域技术人员应当理解，可以在形式上和细节上对其作出各种各样的改变，而不偏离本发明权利要求书所限定的范围。

技术特征：
1.一种越野环境下基于改进的a*算法的路径规划方法，其特征在于，包括以下步骤：a1：将智能车辆的工作空间划分成大小相同的栅格，采用数值矩阵来储存环境信息，通过建立障碍物模型威胁模型和道路模型并融合得到最终的越野环境模型并融合得到最终的越野环境模型其中，障碍物模型，为威胁模型，为道路模型；a2：分析子节点与障碍物的位置关系，建立子节点的选择区域(i,j)；a3：在子节点区域中引入方向变化惩罚规则并通过量化局部区域的信息建立所述越野环境下的评估函数：f(n)＝r
t
(g(n
父
)+η*step)+r
o
(h(n))(h(n))其中，f(n)为全局评估函数，g(n
父
)为节点n父节点的真实代价值，d_p为方向变化惩罚，step为移动代价，为在节点坐标(i,j)越野栅格地图值，h(n)为节点n的预估代价，ε为环境威胁敏感度，d
nt
为节点到目标点的距离，d
st
起始点到目标点的距离；r
t
和r
o
是自适应调节系数，q
o
和q
t
为威胁率和通过率，η为调节系数；a4：设置防碰撞安全距离d实现路径优化，保证所述安全距离d与威胁物的距离l满足l≥d：其中，d为安全距离，为在节点坐标(i,j)越野栅格地图值，cell
d
为单元栅格的长度。2.根据权利要求1所述的一种越野环境下基于改进的a*算法的路径规划方法，其特征在于：步骤a1所述的障碍物模型表示为：在于：步骤a1所述的障碍物模型表示为：其中，障碍物模型，o障碍物区域，(x
ij
,y
ij
)为越野栅格模型的坐标点，r和c是所设置地图大小的长和宽,m
ij
是地图上的每个栅格上数值；所述威胁模型表示为：
其中，为威胁模型，t为威胁物，z为威胁等级，r为威胁范围半径，r和c是所设置地图大小的长和宽,m
ij
是地图上的每个栅格上数值；所述道路模型表示为：表示为：其中，为道路模型，h越野道路，k为道路通行系数,r和c是所设置地图大小的长和宽，m
ij
是地图上的每个栅格上数值。3.根据权利要求1所述的一种越野环境下基于改进的a*算法的路径规划方法，其特征在于：步骤a2中所述子节点的选择区域需通过以下规则进行：relu1：若子节点4或子节点12具有威胁(在越野环境栅格地图中值≥1)，则子节点2、子节点6、子节点4、子节点5或子节点13、子节点9、子节点14、子节点11不作为预选点。rule2：若子节点16或子节点8具有威胁，则子节点2、子节点13、子节点15、子节点1或子节点6、子节点9、子节点10、子节点7不作为预选点。rule3：均无具威胁，则不做处理。4.根据权利要求1所述的一种越野环境下基于改进的a*算法的路径规划方法，其特征在于：步骤a3中所述越野环境下的评估函数的设计包括以下步骤：c1：引入方向惩罚规则：计算当前节点与该其父节点的方向direction1和当前节点到其子节点的方向direction2，计算方向变化d_change＝|direction1-direction2|，若d_change>4，则将方向变化惩罚d_p置为无穷大，若d_change≤4，则选择相应的方向变化惩罚系数；c2：通过量化局部区域信息判断是否存在障碍物，若有障碍物，则根据威胁率q
o
寻找更优路径；若无障碍物，则根据通过率q
t
缩小搜索范围。c3：将得到的方向变化惩罚d_p、局部区域的威胁率q
o
和通过率q
t
，在越野环境下代入评估函数计算。5.根据权利要求1所述的一种越野环境下基于改进的a*算法的路径规划方法，其特征在于：所述步骤a4中，保证所述安全距离d与威胁物的距离l满足l≥d，具体步骤为：d1：设置s为起始点，s坐标为(x
s
,y
s
)，正向floyd算法，从起始点s开始，按步长k取下一路径点1，计算距离l与安全距离d并判断小大，若满足l≥d则取下一路径点2，直至存在不满足l≥d的路径点n，则重新设置点n-1为开始点，继续取点循环以上步骤直至遇到终点t循环结束；d2：反向floyd算法，将终点t设置为起始点，按t
→
s的方向遍历所述d1中的路径点直至遇见起始点s循环结束；d3：若正向floyd算法优化路径与反向floyd算法优化路径存在交点，则取交点作为路
径拐点；若不存在交点，则取拐点数与路径长度和小的路径。6.根据权利要求4所述的一种越野环境下基于改进的a*算法的路径规划方法，其特征在于：步骤c2所述的威胁率q
o
和通过率q
t
通过以下公式计算：通过以下公式计算：其中，q
o
为威胁率，q
t
为通过率，l
o
为局部区域，越野环境栅格地图值，δ
t
为环境敏感度，考虑到越野智能车辆，对于草地土路能够轻松驶过，设置为0.5，可根据车辆类型工作任务灵活选取。n
l
,n
d
为越野栅格地图中一行和一列均小于δ
t
的条数，l和d为局部区域的行和列。

技术总结
本发明公开了一种越野环境下基于改进的A*算法的路径规划方法，属于路径规划技术领域，包括以下步骤：将车辆的工作空间分成相同的栅格，采用数值矩阵来储存环境信息，建立障碍物模型威胁模型和道路模型并融合得到最终的越野环境模型分析子节点与障碍物的位置关系，建立子节点的选择区域；在选择区域中引入方向变化惩罚规则并通过量化局部区域的信息建立越野环境下的评估函数；通过设置防碰撞安全距离D实现路径优化。本发明提供一种方法能够在障碍物、环境威胁和道路条件共同耦合作用的越野环境条件下快速有效的规划出安全、可行和高效的行驶路径，所规划的路径相比传统的A*算法拐点数减少了4倍，效率提高了30％。提高了30％。提高了30％。


技术研发人员：陈星 郑讯佳 罗天洪 张涛
受保护的技术使用者：重庆文理学院
技术研发日：2022.04.12
技术公布日：2022/7/5