提交 4b99277b 编写于 作者: H Hongyi 提交者: Xiangquan Xiao

Prediction: fix ego_back_lane_id logic and not AssignCautionByMerge() for ego_lane

上级 c4910f1b
......@@ -343,10 +343,10 @@ void ObstaclesPrioritizer::AssignCautionLevelByEgoReferenceLine() {
// insert ego_back_lane_id
accumulated_s = 0.0;
for (const std::string& lane_id : lane_ids) {
ego_back_lane_id_set_.insert(lane_id);
if (lane_id == ego_lane_id) {
break;
}
ego_back_lane_id_set_.insert(lane_id);
}
// then loop through lane_ids to AssignCaution for obstacle vehicles
......@@ -361,7 +361,9 @@ void ObstaclesPrioritizer::AssignCautionLevelByEgoReferenceLine() {
continue;
}
accumulated_s += lane_info_ptr->total_length();
AssignCautionByMerge(lane_info_ptr);
if (lane_id != ego_lane_id) {
AssignCautionByMerge(lane_info_ptr);
}
AssignCautionByOverlap(lane_info_ptr);
if (accumulated_s > FLAGS_caution_search_distance_ahead + ego_vehicle_s) {
break;
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册