Baidu Apollo代码解析之轨迹规划中的轨迹评估代价函数

大家好,我已经把优快云上的博客迁移到了知乎上,欢迎大家在知乎关注我的专栏慢慢悠悠小马车https://zhuanlan.zhihu.com/duangduangduang。希望大家可以多多交流,互相学习。


Baidu Apollo中包含了2种轨迹规划方法:Lattice Planner 和 EM Planner。其中,Lattice主要是采样和剪枝的思想,EM主要是优化的思想。二者的目标都是求取代价最小的路径,那么,代价函数设计的好坏,就至关重要了。

Lattice Planner

Lattice Planner主要设计了6个代价函数(3.5版本),考虑了到达目标、平滑、避免碰撞、向心加速度、横向偏移、舒适性等因素。

  • 纵向,到达设定速度、行驶距离

speed\, cost = \frac{ \sum_{t = 0}^{t = T} \left ( t^{2}\cdot \left | v_{ref}(t) - v_{lon}(t) \right | \right )} { \sum_{t = 0}^{t = T} t^{2}} 

dist\, travelled\, cost = \frac{1}{1+dist(T)}

longitudinal\, objective\, cost = \frac{w_{1}\cdot speed \, cost + w_{2}\cdot dist\, travelled\, cost} {w_{1}+w_{2}}

上式中,T是指轨迹时间长度,后面会有我对这个量的设置的理解。dist(T)是在指定时间内行驶的距离,也就是轨迹的长度。

  • 纵向,平滑

评论 6
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值