Procházet zdrojové kódy

Merge main into kiosk_mode branch

tuanchris před 3 měsíci
rodič
revize
18554a0cfc
1 změnil soubory, kde provedl 11 přidání a 2 odebrání
  1. 11 2
      modules/connection/connection_manager.py

+ 11 - 2
modules/connection/connection_manager.py

@@ -445,8 +445,17 @@ def home(timeout=15):
                 finally:
                     loop.close()
 
-            state.current_theta = state.current_rho = 0
-            homing_success = True
+            # Wait for device to reach idle state after homing
+            logger.info("Waiting for device to reach idle state after homing...")
+            idle_reached = check_idle()
+
+            if idle_reached:
+                state.current_theta = state.current_rho = 0
+                homing_success = True
+                logger.info("Homing completed and device is idle")
+            else:
+                logger.error("Device did not reach idle state after homing")
+
             homing_complete.set()
         except Exception as e:
             logger.error(f"Error during homing: {e}")