基于二次规划的自动驾驶车辆路径规划,C++源码

Github页面:path_optimizer

一个路径规划的C++包,在这里记录一下实现的原理和细节。
基于二次规划的自动驾驶车辆路径规划,C++源码

一、实现记录

(待补充)

  1. 在全局路径附近搜索;
  2. 平滑,不考虑障碍物,提供参考线;
  3. 在Frenet坐标系下优化。

二、步骤示意图

1. 输入全局路径(红点)

基于二次规划的自动驾驶车辆路径规划,C++源码

2. 搜索(黄点)

基于二次规划的自动驾驶车辆路径规划,C++源码

3. 参考线平滑(黄线)

基于二次规划的自动驾驶车辆路径规划,C++源码

4. 二次规划求解

基于二次规划的自动驾驶车辆路径规划,C++源码

三、仿真

基于二次规划的自动驾驶车辆路径规划,C++源码