智驾车技术栈 |Apollo规划模块详解(三):算法实现-9类交通规则(上)
前文链接
引
车辆在道路上行驶必然受到交通规则的限制,Apollo中对交通规则的应用是把交通规则作为虚拟障碍物,处理后相关信息存入ReferenceLineInfo中。
对交通规则的整个梳理流程在上图所示的for循环中进行,通过for循环来遍历配置文件/apollo/modules/planning/conf/traffic_rule_config.pb.txt中设置的交通规则,主要涉及的交通规则有以下九类:
交通规则
BACKSIDE_VEHICLE(后向来车)
CROSSWALK(人行横道)
DESTINATION(目的地)
KEEP_CLEAR(禁停区)
REFERENCE_LINE_END(参考线结束)
REROUTING(重新路由)
STOP_SIGN(停车)
TRAFFIC_LIGHT(交通灯)
YIELD_SIGN(让行)
接下来对每一个交规对应的决策处理进行展开介绍。
1.1 BACKSIDE_VEHICLE
在对后向来车的处理决策中,会对path_decision中的每一个障碍物进行遍历,在遍历时,如果是后向车辆,则选择忽略,即通过调用函数PathDecision::AddLongitudinalDecision()和函数PathDecision::AddLateralDecision()为障碍物打上"ignore”的标签,这两个函数的处理逻辑比较简单,这里就不再展开介绍。需要"ignore”的后向车辆主要是下面的2、3、4三种情况,在4中,如果后向车辆的横向距离较大,其可能会选择超车,不能忽略,因此在此处不作处理。
1. 在对后向车辆的情况处理时,对于前方障碍物及警戒级别的障碍物不作处理
2.如果参考线上没有障碍物运动轨迹,则忽略
3.如果障碍物轨迹距离无人车的最近距离小于一个车长,则忽略
4.如果距离本车横向距离小于一定阈值的后向车辆,说明车辆不会超车.选择忽略
1.2 CROSSWALK
1.在对遇人行横道的情况进行处理时,首先从地图中获取所有的人行横道,然后其进行遍历。
(1)
当车头驶过人行横道的距离超过阈值min_pass_s_distance时,如果当前的crosswalk_status中crosswalk_id信息,且crosswalk_id就是当前正在遍历的crosswalk_id,则清除rosswalk_status中的ID及停止时间信息,即不需要停车;
(2)
如果已经通过行人横道,则忽略;
(3)
对path_decision中的障碍物进行遍历,
i)通过调用函数GetADCStopDeceleration(),根据车头位置和停止线之间的距离计算停车减速度;
ii)通过调用函数Crosswalk::CheckStopForObstacle()来判断正在遍历的障碍物是否需要停车,这个函数的内部处理对应的代码比较长,这里就不再贴出,只对逻辑处理简单介绍:
(a) 如果障碍物类型不是行人、自行车、移动物体或者位置类型,则直接返回false,不需要停车;
(b) 如果障碍物不在扩展后的人行横道区域内,则直接返回false,不需要停车;
(c)当障碍物的横向距离足够大时(大于stop_loose_l_distance), 如果障碍物的轨迹与参考线相交,则需要停车;
当障碍物的横向距离小于比较严苛的横向停车距离,如果是前道路范围内的前向障碍物,则需要停车;
当障碍物的横向距离小于比较严苛的横向停车距离,如果是不在当前道路范围内但轨迹与参考线相交的障碍物,则需要停车;
当障碍物的横向距离小于比较严苛的横向停车距离,如果是不在当前道路范围内但正在本车靠近的障碍物,则需要停车;
当障碍物的横向距离大于比较严苛的横向停车距离同时小于一定的阈值(宽松的停车距离)时,如果障碍物与参考线轨迹相交,则停车;
iv)如果(iii)处理的结果需要停车,并且停车减速度大于配置文件给出的最大减速度,同时障碍物的横向距离大于比较严苛的横向停车距离,则不再需要停车。
iii)如果需要停车,同时障碍物不在当前所查询的参考线所对应的车道上,且车辆到停止线的距离小于40米,当障碍物移动的速度小于等于0.3时,如果当前障碍物不在crosswalk_stop_timer[crosswalk_id]中,则将其插入其中;如果障碍物已经在了并且stop_time >= config_.crosswalk().stop_timeout(),则不再需要停车;
iv)如果经过(2)和(3)判断之后,最后的结果是需要停车,则pedestrians.push_back(obstacle_id),供后续处理使用;
(4)
如果上述所得vector不为空,则将障碍物和人行横道信息存入crosswalks_to_stop中,至此对人行横道和障碍物的遍历结束。
2. 对上述所得crosswalks_to_stop中的每个人行横道都生成虚拟障碍物(长度为0.1,宽度为车道宽),并设置停车决策信息;同时查找将要遇到的第一个人行横道
3. 更新状态信息
1.3 DESTINATION
到达目的地的情况下,障碍物促使本车采取靠边停车或者寻找合适的停车点。
1. 靠边停车功能激活的情况下(配置文件中默认设置为false)
若存在有效的靠边停车点,则相关处理与人行横道中对遍历后需要停车的人行横道的处理一致,即创建虚拟障碍物,并封装成新的PathObstacle加入该ReferenceLineInfo的pathdecision中。
2.如果靠边停车功能没有激活,或者靠边停车停车情况下没有有效的停车点。
需要注意的是,此场景下车辆的停车点并不是我们所选择的目的地,而是距离一小段距离。
其他的处理就和1中的处理类似。
1.4 KEEP_CLEAR
禁停区分为两类,第一类是传统的禁停区,第二类是交叉路口。对于禁停区的处理和对人行横道上障碍物构建虚拟墙很相似。具体做法是在参考线上构建一块禁停区,从纵向的start_s到end_s(这里的start_s和end_s是禁停区start_s和end_s在参考线上的投影点)。禁停区宽度在配置文件中设定(4米)。
1. 禁停区
在对传统禁停区处理时,首先从地图中获取禁停区的信息,然后遍历获取到的禁停区,对每一个禁停区通过调用函数KeepClear::BuildKeepClearObstacle()做具体的处理:
1) 检查自车是否已经驶入禁停区,如果是,则忽略
2) 对于还未经过的禁停区,,生成虚拟障碍物,并封装到path_obstacle中
2.交叉口
与传统禁停区相比,对交叉口进行处理时,需要根据交叉口的类型来计算交叉口开始的s值(pnc_junction_start_s),用来生成虚拟障碍物的标定框。
1.5 REFERENCE_LINE_END
当参考线结束时,一般需要重新路由查询,所以需要停车,这种情况下如果程序正常,一般是前方没有路了,需要重新查询当前点到目的地新的路由,具体代码也是跟人行横道的不可忽略障碍物一样,在参考线终点前构建一个停止墙障碍物,并打上Stop的标签。
1. 检查车辆是否接近参考线终点,如果是,则不生成虚拟停止墙
2. 生成虚拟的停止墙,并设置相关的决策信息
总结
本篇中我们详细介绍了交通规则中的九种交通规则中的五种:BACKSIDE_VEHICLE(后向来车)、CROSSWALK(人行横道)、DESTINATION(目的地)、KEEP_CLEAR(禁停区)、REFERENCE_LINE_END(参考线结束);在下篇文章中我们会给大家介绍剩下的四种交通规则~
作者简介
猹猹假IT,iGear团队里为数不多的女性(仙女)算法工程师,业余表情包收藏大师,研究内容为规划控制方向,现和团队的小伙伴一起投入自动驾驶领域。空闲时间会将平时的工作经验及积累整理为文章,与君共勉之。
i车Gear联
一群致力于推动汽车智能网联化发展进程的工程师,一群投身于汽车产业数字化变革的小年轻,一个以数据处理和AI技术为汽车研发行业服务的团队,将日常所见、所想、所感分享于此,一起笑看风云起。
相关文章
- React源码学习进阶篇(一)新版React如何调试源码?
- React源码学习进阶(二)初识Fiber架构
- React源码学习进阶(三)rootFiber的创建流程
- React源码学习进阶(四)render流程的入口逻辑详解
- React源码学习进阶(五)beginWork如何处理Fiber
- React源码学习进阶(六)completeWork究竟做了什么
- React源码学习进阶(七)挂载阶段的commitWork
- React源码学习进阶(八)setState底层逻辑
- MATLAB随机波动率SV、GARCH用MCMC马尔可夫链蒙特卡罗方法分析汇率时间序列|附代码数据
- R语言Apriori关联规则、kmeans聚类、决策树挖掘研究京东商城网络购物用户行为数据可视化|附代码数据
- 电量计基础知识介绍:
- 瞧瞧别人家的API接口,那叫一个优雅
- 暴增到 1k star 的开源项目,原来长这样!
- 程序员必备小技能:mac文件备份和清理、常用工具的安装和配置
- 前端小技能:Chrome DevTools中的操作技巧
- SOLIDWORKS 基于浏览器的角色 TOP 10 增强功能
- java小技能:对list集合根据条件进行分组、过滤和字段筛选
- mybatis-plus小技能
- Java小技能:快速创建List常用几种方式
- DBA的技术方向