[Beetle][Nav]fix bug in navicallback during assembly state

sugihara-16 · Sep 24, 2024 · 6307b4f · 6307b4f
1 parent 01175d2
commit 6307b4f
Showing 1 changed file with 1 addition and 1 deletion.
diff --git a/robots/beetle/src/beetle_navigation.cpp b/robots/beetle/src/beetle_navigation.cpp
@@ -98,7 +98,7 @@ void BeetleNavigator::joyStickControl(const sensor_msgs::JoyConstPtr & joy_msg)
 
 void BeetleNavigator::naviCallback(const aerial_robot_msgs::FlightNavConstPtr & msg)
 {
-  if(getNaviState() == TAKEOFF_STATE || BaseNavigator::getNaviState() == LAND_STATE) return;
+  if(getNaviState() == TAKEOFF_STATE || BaseNavigator::getNaviState() == LAND_STATE || getModuleState() != SEPARATED) return;
 
   gps_waypoint_ = false;