基于图搜索和几何曲线融合的路径规划方法

摘要

本发明公开了一种基于图搜索和几何曲线融合的路径规划方法，包括如下步骤：步骤1：得到地图信息，确定车辆的起始点和目标点；步骤2：通过Hybrid A*算法对节点进行拓展，得到新的节点及其状态信息；步骤3：判断新节点在直行状态下，是否能与目标点所在射线相交；步骤4：判断新节点能否通过几何曲线路径到达目标点；步骤5：判断ProState集合是否为空集。本发明的基于图搜索和几何曲线融合的路径规划方法，解决了传统的Hybrid A*无法精确到达目标点、无法满足车辆目标横摆角要求的问题。