Skip to content

Commit

Permalink
fix(goal_planner): fix hasEnoughDistance (autowarefoundation#5411)
Browse files Browse the repository at this point in the history
Signed-off-by: kosuke55 <[email protected]>
  • Loading branch information
kosuke55 authored Oct 26, 2023
1 parent 82a6c0c commit 801fd0d
Showing 1 changed file with 1 addition and 1 deletion.
Original file line number Diff line number Diff line change
Expand Up @@ -1386,7 +1386,7 @@ bool GoalPlannerModule::hasEnoughDistance(const PullOverPath & pull_over_path) c
// so need enough distance to restart.
// distance to restart should be less than decide_path_distance.
// otherwise, the goal would change immediately after departure.
const bool is_separated_path = status_.get_pull_over_path()->partial_paths.size() > 1;
const bool is_separated_path = pull_over_path.partial_paths.size() > 1;
const double distance_to_start = calcSignedArcLength(
pull_over_path.getFullPath().points, current_pose.position, pull_over_path.start_pose.position);
const double distance_to_restart = parameters_->decide_path_distance / 2;
Expand Down

0 comments on commit 801fd0d

Please sign in to comment.