一种全局与局部融合路径规划方法、装置及存储介质

本发明涉及一种全局与局部融合路径规划方法、装置及存储介质，涉及路径规划技术领域。本申请利用改进双向A*搜索算法获取全局起点和全局目标点之间的路点；将路点采用贝塞尔曲线拟合进行优化平滑生成平滑的全局路径；在全局路径的基础上进行局部指引轨迹和规划凸空间的生成，进行局部指引轨迹生成时，截取当前车辆所在全局路径的局部路径，在Frenet坐标系内使用五次多项式曲线进行局部状态空间采样，设定不同采样点间的状态转移代价函数，动态规划筛选出局部指引轨迹；基于迭代LQR算法的轨迹规划算法将规划涉及到不等式约束转化为惩罚加入目标函数，并在规划凸空间中进行轨迹规划的优化。