Skip to content

Commit

Permalink
fix(start_planner): start pose candidates (autowarefoundation#4880)
Browse files Browse the repository at this point in the history
Signed-off-by: kosuke55 <[email protected]>
  • Loading branch information
kosuke55 authored Sep 5, 2023
1 parent bc48f56 commit 6ae2654
Showing 1 changed file with 3 additions and 2 deletions.
Original file line number Diff line number Diff line change
Expand Up @@ -416,6 +416,9 @@ void StartPlannerModule::planWithPriority(
}

const auto is_safe_with_pose_planner = [&](const size_t i, const auto & planner) {
// Set back_finished flag based on the current index
status_.back_finished = i == 0;

// Get the pull_out_start_pose for the current index
const auto & pull_out_start_pose = start_pose_candidates.at(i);

Expand Down Expand Up @@ -495,8 +498,6 @@ void StartPlannerModule::planWithPriority(
for (const auto & p : order_priority) {
if (is_safe_with_pose_planner(p.first, p.second)) {
const std::lock_guard<std::mutex> lock(mutex_);
// Set back_finished flag based on the current index
status_.back_finished = p.first == 0;
return;
}
}
Expand Down

0 comments on commit 6ae2654

Please sign in to comment.