[Ninja][Navigation] Debug about left and right id select.

sugihara-16 · Dec 25, 2024 · be0b25c · be0b25c
1 parent 84d28de
commit be0b25c
Showing 1 changed file with 5 additions and 2 deletions.
diff --git a/robots/ninja/src/ninja_navigation.cpp b/robots/ninja/src/ninja_navigation.cpp
@@ -138,8 +138,11 @@ void NinjaNavigator::updateEntSysState()
   }
   setModuleNum(assembled_modules_ids_.size());
   std::sort(assembled_modules_ids_.begin(), assembled_modules_ids_.end());
-  left_id_ = assembled_modules_ids_.front();
-  right_id_ = assembled_modules_ids_.back();
+  if(assembled_modules_ids_.size() >= 2)
+    {
+      left_id_ = assembled_modules_ids_.front();
+      right_id_ = assembled_modules_ids_.back();
+    }
   if(control_flag_){
     reconfig_flag_ =  (pre_assembled_modules_ != module_num_) ? true : false;
     disassembly_flag_ = (module_num_ < pre_assembled_modules_) ? true : false;