一种基于监控策略的无人车换道路径规划方法

摘要

本发明公开了一种基于监控策略的无人车换道路径规划方法，通过环境信息感知模块判断是否产生新的换道任务；如果产生新的换道任务，则采用基于B样条曲线的方法来规划连续曲率路径；当基于B样条的算法没有解决方案但路径存在时，添加基于快速扩展随机树的算法作为补充算法以尽可能地找到路径；如果路径规划失败或者不存在换道任务，则输出监控轨迹；否则输出换道轨迹。本发明可以同时进行换道轨迹规划和监控轨迹规划，保证车辆换道的安全性和稳定性。