自动驾驶Apollo6.0源码阅读-感知篇:感知融合 前景融合

本文深入解析Apollo6.0自动驾驶系统的感知融合过程,重点介绍了ProbabilisticFusion模块的数据关联、已匹配和未匹配航迹的更新,以及新航迹创建的细节。涉及到的关键技术包括证据推理(DS理论)、卡尔曼滤波以及匈牙利匹配算法在数据融合和跟踪中的应用。

ProbabilisticFusion::FuseForegroundTrack

在这里插入图片描述

matcher_->Associate

自动驾驶Apollo6.0源码阅读-感知篇:感知融合-数据关联

this->UpdateAssignedTracks

匹配上的结果做更新,使用探测更新tracker,tracker类是pdf_tracker

void ProbabilisticFusion::UpdateAssignedTracks(
    const SensorFramePtr& frame,
    const std::vector<TrackMeasurmentPair>& assignments) {
   
   
  TrackerOptions options;
  options.match_distance = 0;
  for (size_t i = 0; i < assignments.size(); ++i) {
   
   
    size_t track_ind = assignments[i].first;
    size_t obj_ind = assignments[i].second;
    //pbf_tracker,观测更新tracker
    trackers_[track_ind]->UpdateWithMeasurement(
        options, frame->GetForegroundObjects()[obj_ind], frame->GetTimestamp());
  }
}

tracker更新的函数中会更新四个部分,existence、motion、shape、type和tracker的信息,前四个fusion的配置参数在modules/perception/proto/pbf_tracker_config.proto,就是init()中的默认值。

// 观测更新tracker
void PbfTracker::UpdateWithMeasurement(const TrackerOptions& options,
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

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

抵扣说明:

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

余额充值