Skip to content

Commit

Permalink
Update planning/behavior_path_planner/autoware_behavior_path_lane_cha…
Browse files Browse the repository at this point in the history
…nge_module/src/scene.cpp

Co-authored-by: mkquda <168697710+mkquda@users.noreply.github.com>
  • Loading branch information
zulfaqar-azmi-t4 and mkquda committed Nov 11, 2024
1 parent 1eaba01 commit 63cafd5
Showing 1 changed file with 2 additions and 3 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -606,11 +606,10 @@ std::optional<PathWithLaneId> NormalLaneChange::extendPath()
forward_path_length) {
return std::nullopt;
}
const auto is_goal_in_target = getRouteHandler()->isInGoalRouteSection(target_lanes.back());

const auto dist_to_end_of_path =
lanelet::utils::getArcCoordinates(target_lanes, path.points.back().point.pose).length;
if (is_goal_in_target) {

if (common_data_ptr_->lanes_ptr->target_lane_in_goal_section) {
const auto goal_pose = getRouteHandler()->getGoalPose();

const auto dist_to_goal = lanelet::utils::getArcCoordinates(target_lanes, goal_pose).length;
Expand Down

0 comments on commit 63cafd5

Please sign in to comment.