提交 9137960c 编写于 作者: S Shu Jiang 提交者: Jinyun Zhou

Planning: disable extending path bounds to include adc in the hybrid scenario

上级 2bc56394
......@@ -58,6 +58,7 @@ stage_config: {
task_type: PATH_BOUNDS_DECIDER
path_bounds_decider_config {
adc_buffer_coeff: 0.0
is_extend_lane_bands_to_include_adc: false
}
}
task_config: {
......
......@@ -152,6 +152,7 @@ message PathBoundsDeciderConfig {
optional double pull_over_approach_lon_distance_adjust_factor = 6
[default = 1.5];
optional double adc_buffer_coeff = 7 [default = 1.0];
optional bool is_extend_lane_bands_to_include_adc = 8 [default = true];
}
//////////////////////////////////
......
......@@ -1181,24 +1181,36 @@ bool PathBoundsDecider::GetBoundaryFromLanesAndADC(
curr_lane_left_width + (lane_borrow_info == LaneBorrowInfo::LEFT_BORROW
? curr_neighbor_lane_width
: 0.0);
double curr_left_bound_adc =
std::fmax(adc_l_to_lane_center_,
adc_l_to_lane_center_ + ADC_speed_buffer) +
GetBufferBetweenADCCenterAndEdge() + ADC_buffer;
double curr_left_bound =
std::fmax(curr_left_bound_lane, curr_left_bound_adc) - offset_to_map;
double curr_right_bound_lane =
-curr_lane_right_width -
(lane_borrow_info == LaneBorrowInfo::RIGHT_BORROW
? curr_neighbor_lane_width
: 0.0);
double curr_right_bound_adc =
std::fmin(adc_l_to_lane_center_,
adc_l_to_lane_center_ + ADC_speed_buffer) -
GetBufferBetweenADCCenterAndEdge() - ADC_buffer;
double curr_right_bound =
std::fmin(curr_right_bound_lane, curr_right_bound_adc) - offset_to_map;
double curr_left_bound = 0.0;
double curr_right_bound = 0.0;
if (config_.path_bounds_decider_config()
.is_extend_lane_bands_to_include_adc()) {
double curr_left_bound_adc =
std::fmax(adc_l_to_lane_center_,
adc_l_to_lane_center_ + ADC_speed_buffer) +
GetBufferBetweenADCCenterAndEdge() + ADC_buffer;
curr_left_bound =
std::fmax(curr_left_bound_lane, curr_left_bound_adc) - offset_to_map;
double curr_right_bound_adc =
std::fmin(adc_l_to_lane_center_,
adc_l_to_lane_center_ + ADC_speed_buffer) -
GetBufferBetweenADCCenterAndEdge() - ADC_buffer;
curr_right_bound =
std::fmin(curr_right_bound_lane, curr_right_bound_adc) -
offset_to_map;
} else {
curr_left_bound = curr_left_bound_lane - offset_to_map;
curr_right_bound = curr_right_bound_lane - offset_to_map;
}
ADEBUG << "At s = " << curr_s
<< ", left_lane_bound = " << curr_lane_left_width
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册