Skip to content

Commit

Permalink
Update planning/behavior_path_planner/src/scene_module/start_planner/…
Browse files Browse the repository at this point in the history
…start_planner_module.cpp

Co-authored-by: Kosuke Takeuchi <[email protected]>
  • Loading branch information
kyoichi-sugahara and kosuke55 authored Nov 10, 2023
1 parent 9a59db1 commit f4da078
Showing 1 changed file with 2 additions and 0 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -799,6 +799,8 @@ std::vector<Pose> StartPlannerModule::searchPullOutStartPoseCandidates(
const auto stop_objects_in_pull_out_lanes =
filterStopObjectsInPullOutLanes(pull_out_lanes, parameters_->th_moving_object_velocity);

// Set the maximum backward distance less than the distance from the vehicle's base_link to the
// lane's rearmost point to prevent lane departure.
const double current_arc_length =
lanelet::utils::getArcCoordinates(pull_out_lanes, start_pose).length;
const double allowed_backward_distance = std::clamp(
Expand Down

0 comments on commit f4da078

Please sign in to comment.