fix(lane_change): fix terminal path not working in some case (#6722)

Signed-off-by: Zulfaqar Azmi <[email protected]>
autowarefoundation · Apr 3, 2024 · 31b5a4c · 31b5a4c
1 parent 5ff3b17
commit 31b5a4c
Showing 1 changed file with 2 additions and 1 deletion.
diff --git a/planning/behavior_path_lane_change_module/src/utils/utils.cpp b/planning/behavior_path_lane_change_module/src/utils/utils.cpp
@@ -439,7 +439,8 @@ PathWithLaneId getReferencePathFromTargetLane(
       .get_child("getReferencePathFromTargetLane"),
     "start: %f, end: %f", s_start, s_end);
 
-  if (s_end - s_start < lane_changing_length) {
+  constexpr double epsilon = 1e-4;
+  if (s_end - s_start + epsilon < lane_changing_length) {
     return PathWithLaneId();
   }