[发明专利]一种非结构化道路车辆路径规划方法

摘要

本发明公开了一种非结构化道路车辆路径规划方法，包括如下步骤：步骤1，输入包含障碍物及道路边界的地图，设置起始构型Ns、目标构型Ng以及目标区域Ag；步骤2，设置初始open集仅包含初始构型Ns；步骤3，从open集中选出代价最小的节点；步骤4，判断节点Ni是否已经存在于open集中；步骤5，判断节点Ni是否搜索至目标区域Ag；步骤6，采用“直线‑圆弧‑直线”停车模型生成精确到达目标构型的停车路径；步骤7，判断所述步骤6生成的各停车路径是否与障碍物发生碰撞；步骤8，路径回溯。本发明的非结构化道路车辆路径规划方法，通过步骤1至步骤8的设置，便可有效的实现车辆路径的规划了。