revert stop path(2)

Signed-off-by: Mamoru Sobue <[email protected]>
autowarefoundation · Jan 27, 2025 · b31d608 · b31d608
1 parent a5d9151
commit b31d608
Showing 1 changed file with 5 additions and 0 deletions.
diff --git a/...avior_path_planner/autoware_behavior_path_goal_planner_module/src/goal_planner_module.cpp b/...avior_path_planner/autoware_behavior_path_goal_planner_module/src/goal_planner_module.cpp
@@ -1479,6 +1479,11 @@ BehaviorModuleOutput GoalPlannerModule::planPullOverAsCandidate(
 {
   universe_utils::ScopedTimeTrack st(__func__, *time_keeper_);
 
+  // if pull over path candidates generation is not finished, use previous module output
+  if (context_data.lane_parking_response.pull_over_path_candidates.empty()) {
+    return getPreviousModuleOutput();
+  }
+
   BehaviorModuleOutput output{};
   const BehaviorModuleOutput pull_over_output = planPullOverAsOutput(context_data);
   output.modified_goal = pull_over_output.modified_goal;