[发明专利]基于目标方向约束的路径规划算法

摘要

本发明公开了一种基于目标方向约束的路径规划算法，在路径搜索过程中，只保留当前节点与目标节点在同一方向上的可扩展节点，并将这些可扩展节点加入可扩展节点的状态空间，对状态空间中的每一个可扩展节点进行评估，得到估价函数值最小的可扩展节点作为下一个当前节点，重复路径搜索，直到状态空间中估价函数值最小的可扩展节点为目标节点，得到最优路径。本发明在路径搜索过程中，只保留当前节点与目标节点在同一方向上的可扩展节点，减少了当前节点的扩展节点的状态空间中的节点数量，降低了算法的搜索规模，减少了内存资源的占用，提高了算法的搜索效率，适用于各种实时性要求比较高的场景的路径搜索。

主权项

基于目标方向约束的路径规划算法，其特征在于，在路径搜索过程中，只保留当前节点与目标节点在同一方向上的可扩展节点，并将这些可扩展节点加入可扩展节点的状态空间，对状态空间中的每一个可扩展节点进行评估，得到估价函数值最小的可扩展节点作为下一个当前节点，重复路径搜索，直到状态空间中估价函数值最小的可扩展节点为目标节点，得到最优路径；所述状态空间的确定方法为：设当前节点为S，当前节点S的可扩展节点为N个，连线当前节点S与目标节点D，分别作该N个可扩展节点在连线方向上的投影，选取投影恰好落在连线上方向上的节点加入状态空间；针对每个可扩展节点的评估，采用该可扩展节点的启发式估价函数进行计算，f'(x)函数定义式为：f'(x)＝g(x)+h'(x)式中，f'(x)是f(x)的估价函数，其中f(x)是从当前节点S到达目标节点D的实际代价值，g(x)是从当前节点S到可扩展节点X的实际代价值；h'(x)是启发函数，是h(x)的估计函数，其中h(x)是从可扩展节点X到目标节点D的实际的最小代价值，h'(x)小于可扩展节点X到目标节点D的最小代价；利用上述估价函数f'(x)来衡量状态空间中所有可扩展节点的重要程度，可扩展节点的估价函数的值越小，该可扩展节点对寻路来讲就越重要，因此最终即选取估价函数值最小的可扩展节点，将其作为下一步待扩展的当前节点。