基于环境风险的自动驾驶局部路径规划算法

针对结构化道路局部路径规划问题,提出基于实时环境风险场的自动驾驶局部路径动态规划框架,首次将局部路径规划问题细化为车道决策和路径规划两部分。针对车道决策部分,提出基于行车风险场及安全距离的车道决策算法,能够在保证驾驶速度的同时,确保自车始终处于低风险驾驶环境,以提高其安全性。在换道路径规划部分,提出基于换道时间均匀采样的候选路径生成算法,以及综合考虑换道即时性、速度平滑性、路径平顺性以及舒适性的代价函数,实现最优路径规划。在单车道路径规划部分,提出综合考虑安全性、平顺性以及连续性的代价函数,实现路径以及速度的合理、安全动态规划。实验验证表明,所提出的局部路径动态规划框架在设定的结构化道路局部路径规划任务中,能够规划出低风险、高效率、安全合理且平顺的行驶路径并给出安全规划速度,证明了所提出的局部路径动态规划算法的有效性。