From a284f6f4f85ede3a9d24cf6af5218c0f813b9b79 Mon Sep 17 00:00:00 2001
From: UsamaEquinorAFK <muu@equinor.com>
Date: Fri, 6 Oct 2023 15:44:33 +0200
Subject: [PATCH] Switch robot status when its stuck

---
 src/isar_robot/robotinterface.py | 3 +--
 1 file changed, 1 insertion(+), 2 deletions(-)

diff --git a/src/isar_robot/robotinterface.py b/src/isar_robot/robotinterface.py
index 77c3345f..18d387d4 100644
--- a/src/isar_robot/robotinterface.py
+++ b/src/isar_robot/robotinterface.py
@@ -228,7 +228,6 @@ def _get_pressure_telemetry(self, isar_id: str, robot_name: str) -> str:
     def robot_status(self) -> RobotStatus:
         obstacle_status = self._update_obstacle_status()
         if obstacle_status:
-            print(self.obstacle_status)
             return RobotStatus.Stuck
         else:
             return RobotStatus.Available
@@ -334,5 +333,5 @@ def _update_pressure_level(self) -> float:
         return self.pressure_level
 
     def _update_obstacle_status(self) -> bool:
-        self.obstacle_status = True
+        self.obstacle_status = False
         return self.obstacle_status