feat(start_planner): add offset to not finish before engage (#4121)

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
autowarefoundation · Jun 30, 2023 · 8381f8e · 8381f8e
1 parent f5b4053
commit 8381f8e
Showing 1 changed file with 3 additions and 1 deletion.
diff --git a/planning/behavior_path_planner/src/scene_module/start_planner/start_planner_module.cpp b/planning/behavior_path_planner/src/scene_module/start_planner/start_planner_module.cpp
@@ -682,7 +682,9 @@ bool StartPlannerModule::hasFinishedPullOut() const
   const auto arclength_pull_out_end =
     lanelet::utils::getArcCoordinates(status_.current_lanes, status_.pull_out_path.end_pose);
 
-  const bool has_finished = arclength_current.length - arclength_pull_out_end.length > 0.0;
+  // offset to not finish the module before engage
+  constexpr double offset = 0.1;
+  const bool has_finished = arclength_current.length - arclength_pull_out_end.length > offset;
 
   return has_finished;
 }