fix check algorithm

Signed-off-by: ismetatabay <[email protected]>
autowarefoundation · Nov 24, 2022 · 9168592 · 9168592
1 parent 83256a8
commit 9168592
Show file tree

Hide file tree

Showing 2 changed files with 6 additions and 3 deletions.
diff --git a/...or_path_planner/include/behavior_path_planner/scene_module/avoidance/avoidance_module.hpp b/...or_path_planner/include/behavior_path_planner/scene_module/avoidance/avoidance_module.hpp
@@ -213,8 +213,9 @@ class AvoidanceModule : public SceneModuleInterface
   void updateRegisteredRawShiftLines();
 
   // -- for state management --
+  bool is_avoidance_maneuver_starts;
+  bool isAvoidanceManeuverRunning();
   bool isAvoidancePlanRunning() const;
-  bool isAvoidanceManeuverRunning() const;
 
   // -- for pre-processing --
   void initVariables();

diff --git a/planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp b/planning/behavior_path_planner/src/scene_module/avoidance/avoidance_module.cpp
@@ -127,12 +127,13 @@ bool AvoidanceModule::isAvoidancePlanRunning() const
   const bool has_shift_line = (path_shifter_.getShiftLinesSize() > 0);
   return has_base_offset || has_shift_line;
 }
-bool AvoidanceModule::isAvoidanceManeuverRunning() const
+bool AvoidanceModule::isAvoidanceManeuverRunning()
 {
   const auto path_idx = avoidance_data_.ego_closest_path_index;
 
   for (const auto & al : registered_raw_shift_lines_) {
-    if (path_idx > al.start_idx || registered_raw_shift_lines_.size() == 1) {
+    if (path_idx > al.start_idx || is_avoidance_maneuver_starts) {
+      is_avoidance_maneuver_starts = true;
       return true;
     }
   }
@@ -2682,6 +2683,7 @@ void AvoidanceModule::initVariables()
   registered_raw_shift_lines_ = {};
   current_raw_shift_lines_ = {};
   original_unique_id = 0;
+  is_avoidance_maneuver_starts = false;
 }
 
 bool AvoidanceModule::isTargetObjectType(const PredictedObject & object) const