ICode9

精准搜索请尝试: 精确搜索
首页 > 其他分享> 文章详细

Apollo6.0概率融合(probabilistic_fusion)

2021-05-10 16:01:48  阅读:781  来源: 互联网

标签:缓存 融合 radar fusion 传感器 发布 probabilistic Apollo6.0


继上篇:Apollo 6.0的融合组件分析(fusion_component)Apollo 6.0的融合模块入口分析(obstacle_multi_sensor_fusion),本文详述2. 主融合逻辑部分(即BaseFusionSystem的Fuse函数)。

代码链接:probabilistic_fusion.cc

1. 流程图

ProbabilisticFusion::Fuse的流程图如下所示,

4. 收集融合帧(CollectFusedFrames) 3. 主融合逻辑(FuseFrame) 2. 获取所有传感器的缓存帧 1. 缓存帧数据 收集允许发布的前景轨迹和后景轨迹并将他们转为Object类型 对每一帧进行融合 对每个传感器分别获取符合时间戳要求的所有缓存帧 是主传感器帧? 开启数据读写锁并缓存帧数据 结束 是配置允许的传感器? 结束

流程图说明:

  • 1. 缓存帧数据时会自动检测帧的SensorId是否在一个名叫sensors_的unordered_map中,如果不在则添加。然后把帧数据加入sensors_的值里。按传感器id缓存帧
  • 2. 获取所有传感器的缓存帧中对每个传感器都抽取从上一次请求获取帧的时间到这次的主传感器帧时间之间的最晚的那一帧。
  • 3. 主融合逻辑(FuseFrame)内容很多,后续文章详述。
  • 4. 收集融合帧(CollectFusedFrames)中允许发布的轨迹的逻辑如下所述
    • 如果lidar看不到,radar看不到,camera看到且给的不是3d目标且障碍物不是交通锥则不能发布
    • 如果在深夜(11点后),以下三点同时为假则不能发布,此处条件来自pbf_keeper.cc
      • 配置中被lidar看到就发布的标志位为true且被lidar看到
      • 配置中被radar看到就发布的标志位为true且被radar看到,与此同时,如果是前向radar直接为假,如果是后向radar,其观测距离大于最小置信距离且速度大于4,存在概率大于设定阈值。
      • 配置中被camera看到就发布的标志位为true且被camera看到且相机输出3d目标且不是深夜且(是交通锥或者距离大于相机最小发布距离)且存在概率大于阈值
    • 运用追踪次数过滤逻辑且追踪次数小于阈值

标签:缓存,融合,radar,fusion,传感器,发布,probabilistic,Apollo6.0
来源: https://blog.csdn.net/lcc47251/article/details/116597936

本站声明: 1. iCode9 技术分享网(下文简称本站)提供的所有内容,仅供技术学习、探讨和分享;
2. 关于本站的所有留言、评论、转载及引用,纯属内容发起人的个人观点,与本站观点和立场无关;
3. 关于本站的所有言论和文字,纯属内容发起人的个人观点,与本站观点和立场无关;
4. 本站文章均是网友提供,不完全保证技术分享内容的完整性、准确性、时效性、风险性和版权归属;如您发现该文章侵犯了您的权益,可联系我们第一时间进行删除;
5. 本站为非盈利性的个人网站,所有内容不会用来进行牟利,也不会利用任何形式的广告来间接获益,纯粹是为了广大技术爱好者提供技术内容和技术思想的分享性交流网站。

专注分享技术,共同学习,共同进步。侵权联系[81616952@qq.com]

Copyright (C)ICode9.com, All Rights Reserved.

ICode9版权所有