Switch robot status when its stuck

equinor · Oct 31, 2023 · 4ca54c8 · 4ca54c8
1 parent c8bbca7
commit 4ca54c8
Showing 1 changed file with 4 additions and 5 deletions.
diff --git a/src/isar_robot/robotinterface.py b/src/isar_robot/robotinterface.py
@@ -226,10 +226,9 @@ def _get_pressure_telemetry(self, isar_id: str, robot_name: str) -> str:
         return json.dumps(pressure_payload, cls=EnhancedJSONEncoder)
 
     def robot_status(self) -> RobotStatus:
-        obstacle_status = self._update_obstacle_status()
-        if obstacle_status:
-            print(self.obstacle_status)
-            return RobotStatus.Stuck
+        obstacle_detected = self._update_obstacle_status()
+        if obstacle_detected:
+            return RobotStatus.Blocked
         else:
             return RobotStatus.Available
 
@@ -333,6 +332,6 @@ def _update_pressure_level(self) -> float:
         self.pressure_level = (100 - randrange(0, 100) * 0.5) * millibar_to_bar
         return self.pressure_level
 
-    def _update_obstacle_status(self) -> bool:
+    def _check_obstacle_status(self) -> bool:
         self.obstacle_status = True
         return self.obstacle_status