cherry-pick(lane_change): check able to return to original lane

* fix(lane_change): check able to return to original lane in abort Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]> * fix cancel state Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]> * revert changes Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]> --------- Signed-off-by: Muhammad Zulfaqar Azmi <[email protected]>
tier4 · Jan 11, 2024 · 47e905c · 47e905c
1 parent 86e32ba
commit 47e905c
Showing 1 changed file with 5 additions and 0 deletions.
diff --git a/planning/behavior_path_lane_change_module/src/interface.cpp b/planning/behavior_path_lane_change_module/src/interface.cpp
@@ -276,6 +276,11 @@ bool LaneChangeInterface::canTransitFailureState()
     return false;
   }
 
+  if (!module_type_->isAbleToReturnCurrentLane()) {
+    log_debug_throttled("It's is not possible to return to original lane. Continue lane change.");
+    return false;
+  }
+
   const auto found_abort_path = module_type_->calcAbortPath();
   if (!found_abort_path) {
     log_debug_throttled(