大家好,我已经把优快云上的博客迁移到了知乎上,欢迎大家在知乎关注我的专栏慢慢悠悠小马车(https://zhuanlan.zhihu.com/duangduangduang)。希望大家可以多多交流,互相学习。
Baidu Apollo中包含了2种轨迹规划方法:Lattice Planner 和 EM Planner。其中,Lattice主要是采样和剪枝的思想,EM主要是优化的思想。二者的目标都是求取代价最小的路径,那么,代价函数设计的好坏,就至关重要了。
Lattice Planner
Lattice Planner主要设计了6个代价函数(3.5版本),考虑了到达目标、平滑、避免碰撞、向心加速度、横向偏移、舒适性等因素。
-
纵向,到达设定速度、行驶距离
上式中,T是指轨迹时间长度,后面会有我对这个量的设置的理解。dist(T)是在指定时间内行驶的距离,也就是轨迹的长度。
- 纵向,平滑