自动驾驶之路径规划提升篇
上一讲:b站老王 自动驾驶决策规划学习记录(九)
接着上一讲学习记录b站老王对自动驾驶规划系列的讲解
参考视频:自动驾驶决策规划第二章第五节 路径规划总结与疑难解答
- 二次规划崩溃问题
- 车控制不稳,抖动剧烈问题
- 决策不稳定,朝令夕改问题
- 速度规划如何影响路径规划
1 二次规划崩溃
在靠近障碍物时,二次规划崩溃
为什么在无避障时不会崩溃?
为什么规划的路径会贴着边界
这是因为二次规划的性质决定的
改进:
- 规划起点不管了,障碍物放大一点做安全缓冲/
- 改极小值点的位置
c e n t r e l i n e = 1 2 ( l m i n + l m a x ) centre_{}line=\frac{1}{2}(l_{min}+l_{max}) centreline=21(lmin+lmax)
优点:几何稳定
缺点: w c e n t r e w_{centre} wcentre调小不起明显作用,调大了路径不平滑。
曲线平滑相对好做。
缺点:dp_path几何不稳定
dp_path每一帧之间的几何形状都会有巨大变化,若二次规划以dp_path为centre line,qp_path也会震荡。
相反, c e n t r e l i n e = 1 2 ( l m i n + l m a x ) centre_{}line=\frac{1}{2}(l_{min}+l_{max}) centreline=21(lmin+lmax)就很稳定
2车控制不稳,抖动剧烈
根源:车规划的路径会天然往边界靠拢的趋势
解决:不允许反复横跳,加约束
新的问题:约束越多,求解越慢(反直觉)
解决:削二次规划的规模,由60->20,二次规划求解完毕后再进行插值增密。
3 决策“朝令夕改”
解决:暂时无解 Matlab
Apollo,打标签
Matlab对结构体,字符串的支持有点弱,尽快切入C++
4 速度规划对路径规划的影响
path -> 只处理静态,有问题
已知上一帧的速度规划为10m/s匀速,上一帧的path为直线
path规划要拿上一帧的轨迹去判断与动态障碍物的交互
EM planner是SL planning与ST planning反复迭代的过程