提交 df29d39a 编写于 作者: J JasonZhou404 提交者: Jinyun Zhou

Planning: fix side pass stop

上级 6a607ee4
...@@ -145,17 +145,17 @@ void RuleBasedStopDecider::StopOnSidePass( ...@@ -145,17 +145,17 @@ void RuleBasedStopDecider::StopOnSidePass(
mutable_side_pass_info->set_check_clear_flag(false); mutable_side_pass_info->set_check_clear_flag(false);
} }
if (!LaneChangeDecider::IsPerceptionBlocked(
*reference_line_info,
rule_based_stop_decider_config_.search_beam_length(),
rule_based_stop_decider_config_.search_beam_radius_intensity(),
rule_based_stop_decider_config_.search_range(),
rule_based_stop_decider_config_.is_block_angle_threshold())) {
return;
}
if (!side_pass_info.check_clear_flag() && if (!side_pass_info.check_clear_flag() &&
CheckSidePassStop(path_data, *reference_line_info, &stop_s_on_pathdata)) { CheckSidePassStop(path_data, *reference_line_info, &stop_s_on_pathdata)) {
if (!LaneChangeDecider::IsPerceptionBlocked(
*reference_line_info,
rule_based_stop_decider_config_.search_beam_length(),
rule_based_stop_decider_config_.search_beam_radius_intensity(),
rule_based_stop_decider_config_.search_range(),
rule_based_stop_decider_config_.is_block_angle_threshold()) &&
LaneChangeDecider::IsClearToChangeLane(reference_line_info)) {
return;
}
if (!CheckADCStop(path_data, *reference_line_info, stop_s_on_pathdata)) { if (!CheckADCStop(path_data, *reference_line_info, stop_s_on_pathdata)) {
if (!BuildSidePassStopFence( if (!BuildSidePassStopFence(
path_data, stop_s_on_pathdata, path_data, stop_s_on_pathdata,
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册