From 24c81de2e15ad4515a3f373c87ec45e5a1493156 Mon Sep 17 00:00:00 2001
From: UsamaEquinorAFK <muu@equinor.com>
Date: Thu, 5 Oct 2023 13:51:23 +0200
Subject: [PATCH] Check for Obstacle status report

---
 src/isar_robot/robotinterface.py | 4 +++-
 1 file changed, 3 insertions(+), 1 deletion(-)

diff --git a/src/isar_robot/robotinterface.py b/src/isar_robot/robotinterface.py
index 4665f916..77c3345f 100644
--- a/src/isar_robot/robotinterface.py
+++ b/src/isar_robot/robotinterface.py
@@ -226,7 +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:
-        if self._update_obstacle_status():
+        obstacle_status = self._update_obstacle_status()
+        if obstacle_status:
+            print(self.obstacle_status)
             return RobotStatus.Stuck
         else:
             return RobotStatus.Available