diff --git a/src/isar_robot/robotinterface.py b/src/isar_robot/robotinterface.py index eb898dff..1b3de99e 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