do not decel when searching

Signed-off-by: kosuke55 <[email protected]>
autowarefoundation · Nov 13, 2023 · 7794e3d · 7794e3d
1 parent 9815f5f
commit 7794e3d
Showing 1 changed file with 5 additions and 0 deletions.
diff --git a/planning/behavior_path_planner/src/scene_module/goal_planner/goal_planner_module.cpp b/planning/behavior_path_planner/src/scene_module/goal_planner/goal_planner_module.cpp
@@ -844,6 +844,11 @@ BehaviorModuleOutput GoalPlannerModule::planRunning()
 
 BehaviorModuleOutput GoalPlannerModule::planPullOverAsCandidate()
 {
+  // if pull over path candidates generation is not finished, use previous module output
+  if (thread_safe_data_.get_pull_over_path_candidates().empty()) {
+    return getPreviousModuleOutput();
+  }
+
   BehaviorModuleOutput output{};
   const BehaviorModuleOutput pull_over_output = planPullOver();
   output.modified_goal = pull_over_output.modified_goal;