feat(pull_out): change pull out finish deviation threshould

Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
autowarefoundation · Jun 7, 2023 · 73265f4 · 73265f4
1 parent 35bc65a
commit 73265f4
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/planning/behavior_path_planner/src/scene_module/pull_out/pull_out_module.cpp b/planning/behavior_path_planner/src/scene_module/pull_out/pull_out_module.cpp
@@ -685,13 +685,13 @@ bool PullOutModule::hasFinishedPullOut() const
   // are also running at the same time.
   const double lateral_offset_to_path =
     motion_utils::calcLateralOffset(getCurrentPath().points, current_pose.position);
-  constexpr double lateral_offset_threshold = 0.5;
+  constexpr double lateral_offset_threshold = 0.2;
   if (std::abs(lateral_offset_to_path) > lateral_offset_threshold) {
     return false;
   }
   const double yaw_deviation =
     motion_utils::calcYawDeviation(getCurrentPath().points, current_pose);
-  constexpr double yaw_deviation_threshold = 0.5;
+  constexpr double yaw_deviation_threshold = 0.087;  // 5deg
   if (std::abs(yaw_deviation) > yaw_deviation_threshold) {
     return false;
   }