Skip to content

Commit 0b18e63

Browse files
mkqudashmpwk
authored andcommitted
fix(lane_change): correct computation of maximum lane changing length threshold (autowarefoundation#9279)
fix computation of maximum lane changing length threshold Signed-off-by: mohammad alqudah <alqudah.mohammad@tier4.jp>
1 parent c76a8c2 commit 0b18e63

File tree

1 file changed

+2
-7
lines changed
  • planning/behavior_path_planner/autoware_behavior_path_lane_change_module/src

1 file changed

+2
-7
lines changed

planning/behavior_path_planner/autoware_behavior_path_lane_change_module/src/scene.cpp

+2-7
Original file line numberDiff line numberDiff line change
@@ -1415,7 +1415,6 @@ std::vector<LaneChangePhaseMetrics> NormalLaneChange::get_lane_changing_metrics(
14151415
const double shift_length, const double dist_to_reg_element) const
14161416
{
14171417
const auto & route_handler = getRouteHandler();
1418-
const auto & target_lanes = common_data_ptr_->lanes_ptr->target;
14191418
const auto & transient_data = common_data_ptr_->transient_data;
14201419
const auto dist_lc_start_to_end_of_lanes = calculation::calc_dist_from_pose_to_terminal_end(
14211420
common_data_ptr_, common_data_ptr_->lanes_ptr->target_neighbor,
@@ -1426,12 +1425,8 @@ std::vector<LaneChangePhaseMetrics> NormalLaneChange::get_lane_changing_metrics(
14261425
transient_data.is_ego_near_current_terminal_start
14271426
? transient_data.dist_to_terminal_end - prep_metric.length
14281427
: std::min(transient_data.dist_to_terminal_end, dist_to_reg_element) - prep_metric.length;
1429-
auto target_lane_buffer = lane_change_parameters_->lane_change_finish_judge_buffer +
1430-
transient_data.next_dist_buffer.min;
1431-
if (std::abs(route_handler->getNumLaneToPreferredLane(target_lanes.back(), direction_)) > 0) {
1432-
target_lane_buffer += lane_change_parameters_->backward_length_buffer_for_end_of_lane;
1433-
}
1434-
max_length = std::min(max_length, dist_lc_start_to_end_of_lanes - target_lane_buffer);
1428+
max_length =
1429+
std::min(max_length, dist_lc_start_to_end_of_lanes - transient_data.next_dist_buffer.min);
14351430
return max_length;
14361431
});
14371432

0 commit comments

Comments
 (0)