isar 1.16.17__py3-none-any.whl → 1.16.18__py3-none-any.whl

isar/config/settings.env

@@ -14,7 +14,7 @@ ISAR_MQTT_SSL_ENABLED = true
 
 ISAR_AUTHENTICATION_ENABLED = false
 
-ISAR_PLANT_SHORT_NAME = KAA
+ISAR_PLANT_SHORT_NAME = HUA
 
 ISAR_API_HOST_VIEWED_EXTERNALLY = 0.0.0.0
 

isar/services/service_connections/mqtt/robot_info_publisher.py

@@ -24,6 +24,7 @@ class RobotInfoPublisher:
                 video_streams=settings.VIDEO_STREAMS,
                 host=settings.API_HOST_VIEWED_EXTERNALLY,
                 port=settings.API_PORT,
+                capabilities=robot_settings.CAPABILITIES,
                 timestamp=datetime.utcnow(),
             )
 

isar/state_machine/state_machine.py

@@ -1,7 +1,6 @@
 import json
 import logging
 import queue
-import time
 from collections import deque
 from datetime import datetime
 from typing import Deque, List, Optional
@@ -226,18 +225,13 @@ class StateMachine(object):
     def _initiated(self) -> None:
         if self.stepwise_mission:
             self.current_step.status = StepStatus.InProgress
-            self.publish_step_status(step=self.current_step)
-            self.logger.info(
-                f"Successfully initiated "
-                f"{type(self.current_step).__name__} "
-                f"step: {str(self.current_step.id)[:8]}"
-            )
-        else:
-            self.current_mission.status = MissionStatus.InProgress
-            self.logger.info(
-                f"Successfully initiated full mission with ID: "
-                f"{str(self.current_mission.id)[:8]}"
-            )
+        self.current_mission.status = MissionStatus.InProgress
+        self.publish_step_status(step=self.current_step)
+        self.logger.info(
+            f"Successfully initiated "
+            f"{type(self.current_step).__name__} "
+            f"step: {str(self.current_step.id)[:8]}"
+        )
 
     def _pause(self) -> None:
         return
@@ -269,7 +263,9 @@ class StateMachine(object):
         ]
         partially_fail_statuses = fail_statuses + [TaskStatus.PartiallySuccessful]
 
-        if all(task.status in fail_statuses for task in self.current_mission.tasks):
+        if len(self.current_mission.tasks) == 0:
+            self.current_mission.status = MissionStatus.Successful
+        elif all(task.status in fail_statuses for task in self.current_mission.tasks):
             self.current_mission.error_message = ErrorMessage(
                 error_reason=None,
                 error_description="The mission failed because all tasks in the mission "
@@ -296,9 +292,12 @@ class StateMachine(object):
         self.current_mission.status = MissionStatus.InProgress
         self.publish_mission_status()
         self.current_task = self.task_selector.next_task()
-        self.current_task.status = TaskStatus.InProgress
-        self.publish_task_status(task=self.current_task)
-        self.update_current_step()
+        if self.current_task == None:
+            self._mission_finished()
+        else:
+            self.current_task.status = TaskStatus.InProgress
+            self.publish_task_status(task=self.current_task)
+            self.update_current_step()
 
     def _step_finished(self) -> None:
         self.publish_step_status(step=self.current_step)
@@ -307,28 +306,6 @@ class StateMachine(object):
 
     def _full_mission_finished(self) -> None:
         self.current_task = None
-        step_status: StepStatus = StepStatus.Failed
-        task_status: TaskStatus = TaskStatus.Failed
-
-        if self.current_mission.status == MissionStatus.Failed:
-            step_status = StepStatus.Failed
-            task_status = TaskStatus.Failed
-        elif self.current_mission.status == MissionStatus.Cancelled:
-            step_status = StepStatus.Cancelled
-            task_status = TaskStatus.Cancelled
-        elif (
-            self.current_mission.status == MissionStatus.Successful
-            or self.current_mission.status == MissionStatus.PartiallySuccessful
-        ):
-            step_status = StepStatus.Successful
-            task_status = TaskStatus.Successful
-
-        for task in self.current_mission.tasks:
-            task.status = task_status
-            for step in task.steps:
-                step.status = step_status
-                self.publish_step_status(step=step)
-            self.publish_task_status(task=task)
 
     def _mission_paused(self) -> None:
         self.logger.info(f"Pausing mission: {self.current_mission.id}")
@@ -349,26 +326,12 @@ class StateMachine(object):
         self.stopped = True
 
     def _initiate_failed(self) -> None:
-        if self.stepwise_mission:
-            self.current_step.status = StepStatus.Failed
-            self.current_task.update_task_status()
-            self.current_mission.status = MissionStatus.Failed
-            self.publish_step_status(step=self.current_step)
-            self.publish_task_status(task=self.current_task)
-            self._finalize()
-
-        else:
-            self.current_task = None
-            step_status: StepStatus = StepStatus.Cancelled
-            task_status: TaskStatus = TaskStatus.Cancelled
-
-            for task in self.current_mission.tasks:
-                task.status = task_status
-                for step in task.steps:
-                    step.status = step_status
-                    self.publish_step_status(step=step)
-                self.publish_task_status(task=task)
-            self._finalize()
+        self.current_step.status = StepStatus.Failed
+        self.current_task.update_task_status()
+        self.current_mission.status = MissionStatus.Failed
+        self.publish_step_status(step=self.current_step)
+        self.publish_task_status(task=self.current_task)
+        self._finalize()
 
     def _initiate_infeasible(self) -> None:
         if self.stepwise_mission:
@@ -435,9 +398,19 @@ class StateMachine(object):
                 self.current_task = None
 
     def update_current_step(self):
-        if self.current_task:
+        if self.current_task != None:
             self.current_step = self.current_task.next_step()
 
+    def update_remaining_steps(self):
+        if self.current_task:
+            for step in self.current_task.steps:
+                if (
+                    step.status == StepStatus.InProgress
+                    or step.status == StepStatus.NotStarted
+                ):
+                    step.status = self.current_task.status
+                    self.publish_step_status(step=step)
+
     def update_state(self):
         """Updates the current state of the state machine."""
         self.current_state = States(self.state)

isar/state_machine/states/monitor.py

@@ -6,6 +6,7 @@ from typing import Callable, Optional, Sequence, TYPE_CHECKING, Tuple, Union
 from injector import inject
 from transitions import State
 
+from isar.mission_planner.task_selector_interface import TaskSelectorStop
 from isar.services.utilities.threaded_request import (
     ThreadedRequest,
     ThreadedRequestNotFinishedError,
@@ -19,7 +20,7 @@ from robot_interface.models.exceptions.robot_exceptions import (
 )
 from robot_interface.models.inspection.inspection import Inspection
 from robot_interface.models.mission.mission import Mission
-from robot_interface.models.mission.status import MissionStatus
+from robot_interface.models.mission.status import MissionStatus, TaskStatus
 from robot_interface.models.mission.step import InspectionStep, Step, StepStatus
 
 if TYPE_CHECKING:
@@ -56,16 +57,10 @@ class Monitor(State):
                 break
 
             if not self.step_status_thread:
-                if self.state_machine.stepwise_mission:
-                    self._run_get_status_thread(
-                        status_function=self.state_machine.robot.step_status,
-                        thread_name="State Machine Monitor Get Step Status",
-                    )
-                else:
-                    self._run_get_status_thread(
-                        status_function=self.state_machine.robot.mission_status,
-                        thread_name="State Machine Monitor Get Mission Status",
-                    )
+                self._run_get_status_thread(
+                    status_function=self.state_machine.robot.step_status,
+                    thread_name="State Machine Monitor Get Step Status",
+                )
 
             try:
                 status: Union[StepStatus, MissionStatus] = (
@@ -97,19 +92,19 @@ class Monitor(State):
 
             except RobotException as e:
                 self._set_error_message(e)
-                if self.state_machine.stepwise_mission:
-                    status = StepStatus.Failed
-                else:
-                    status = MissionStatus.Failed
+                status = StepStatus.Failed
 
                 self.logger.error(
                     f"Retrieving the status failed because: {e.error_description}"
                 )
 
-            if self.state_machine.stepwise_mission and isinstance(status, StepStatus):
+            if isinstance(status, StepStatus):
                 self.state_machine.current_step.status = status
             elif isinstance(status, MissionStatus):
                 self.state_machine.current_mission.status = status
+                self.logger.error(
+                    f"Received an invalid status update when monitoring mission. Only StepStatus is expected."
+                )
 
             if self._should_upload_inspections():
                 get_inspections_thread = ThreadedRequest(
@@ -126,7 +121,28 @@ class Monitor(State):
                     transition = self.state_machine.step_finished  # type: ignore
                     break
             else:
-                if self._mission_finished(self.state_machine.current_mission):
+                if isinstance(status, StepStatus):
+                    if self._step_finished(self.state_machine.current_step):
+                        self.state_machine.current_task.update_task_status()
+                    else:  # If not all steps are done
+                        self.state_machine.current_task.status = TaskStatus.InProgress
+
+                    self.state_machine.publish_task_status(
+                        self.state_machine.current_task
+                    )
+                    if self.state_machine.current_task.status == TaskStatus.Successful:
+                        self.state_machine.update_remaining_steps()
+                        try:
+                            self.state_machine.current_task = (
+                                self.state_machine.task_selector.next_task()
+                            )
+                        except TaskSelectorStop:
+                            # Indicates that all tasks are finished
+                            self.state_machine.current_task = None
+                            transition = self.state_machine.full_mission_finished  # type: ignore
+                            break
+                        self.state_machine.update_current_step()
+                elif self._mission_finished(self.state_machine.current_mission):
                     transition = self.state_machine.full_mission_finished  # type: ignore
                     break
 
@@ -196,28 +212,15 @@ class Monitor(State):
         return False
 
     def _should_upload_inspections(self) -> bool:
-        if self.state_machine.stepwise_mission:
-            step: Step = self.state_machine.current_step
-            return (
-                self._step_finished(step)
-                and step.status == StepStatus.Successful
-                and isinstance(step, InspectionStep)
-            )
-        else:
-            mission_status: MissionStatus = self.state_machine.current_mission.status
-            if (
-                mission_status == MissionStatus.Successful
-                or mission_status == MissionStatus.PartiallySuccessful
-            ):
-                return True
-            return False
+        step: Step = self.state_machine.current_step
+        return (
+            self._step_finished(step)
+            and step.status == StepStatus.Successful
+            and isinstance(step, InspectionStep)
+        )
 
     def _set_error_message(self, e: RobotException) -> None:
         error_message: ErrorMessage = ErrorMessage(
             error_reason=e.error_reason, error_description=e.error_description
         )
-        if self.state_machine.stepwise_mission:
-            self.state_machine.current_step.error_message = error_message
-        else:
-            if self.state_machine.current_mission:
-                self.state_machine.current_mission.error_message = error_message
+        self.state_machine.current_step.error_message = error_message

{isar-1.16.17.dist-info → isar-1.16.18.dist-info}/METADATA

@@ -1,6 +1,6 @@
 Metadata-Version: 2.1
 Name: isar
-Version: 1.16.17
+Version: 1.16.18
 Summary: Integration and Supervisory control of Autonomous Robots
 Home-page: https://github.com/equinor/isar
 Author: Equinor ASA

{isar-1.16.17.dist-info → isar-1.16.18.dist-info}/RECORD

@@ -13,7 +13,7 @@ isar/config/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
 isar/config/configuration_error.py,sha256=rO6WOhafX6xvVib8WxV-eY483Z0PpN-9PxGsq5ATfKc,46
 isar/config/log.py,sha256=39G_Cue0qvw0Uv-1NYXvQ83yivPIKcAv-bGNNREFw5o,2251
 isar/config/logging.conf,sha256=mYO1xf27gAopEMHhGzY7-mwyfN16rwRLkPNMvy3zn2g,1127
-isar/config/settings.env,sha256=-RCBJiVRWBLky7FKuQX1qYXy8rCzTNLM4LDuyp12EbY,535
+isar/config/settings.env,sha256=-kivj0osAAKlInnY81ugySTlcImhVABbnj9kUoBDLu8,535
 isar/config/settings.py,sha256=ZECul4dywwZb-hJeWi-4XfjrUjthqMs42bNfsyI7feA,13056
 isar/config/certs/ca-cert.pem,sha256=gSBTyY0tKSFnssyvrvbFvHpQwii0kEkBryklVmevdtc,2029
 isar/config/keyvault/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
@@ -59,7 +59,7 @@ isar/services/service_connections/request_handler.py,sha256=0LxC0lu_HXeEf_xmJWjf
 isar/services/service_connections/mqtt/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
 isar/services/service_connections/mqtt/mqtt_client.py,sha256=Aib0lqaddxW9aVXXYD7wGL9jIpr2USCCH91SQgFdIG4,3548
 isar/services/service_connections/mqtt/robot_heartbeat_publisher.py,sha256=TxvpLA_qfyXwwN58h2X-eomTnhbFPhqfjamPxBz084E,1000
-isar/services/service_connections/mqtt/robot_info_publisher.py,sha256=_7lXSyOaTbde584M67bG7N9sQJH51yhaSuhsjuCM02U,1325
+isar/services/service_connections/mqtt/robot_info_publisher.py,sha256=d5HQ6Hfp5E21kaj1IJsFMWXecbzvH8iYByZhOucR004,1383
 isar/services/service_connections/mqtt/robot_status_publisher.py,sha256=KPxRrdtu-yLQolQ7DejC1v1NCeELUzrK_ZoiEpsrqD4,4425
 isar/services/service_connections/stid/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
 isar/services/utilities/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
@@ -67,13 +67,13 @@ isar/services/utilities/queue_utilities.py,sha256=Pw3hehSwkXJNeDv-bDVDfs58VOwtt3
 isar/services/utilities/scheduling_utilities.py,sha256=LFimEmacML3J9q-FNLfKPhcAr-R3f2rkYkbsoro0Gyo,8434
 isar/services/utilities/threaded_request.py,sha256=py4G-_RjnIdHljmKFAcQ6ddqMmp-ZYV39Ece-dqRqjs,1874
 isar/state_machine/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
-isar/state_machine/state_machine.py,sha256=HXH9XuXRUfhKZQdp5IfwV-Do-QRRConpyiUBFl_p-mU,23707
+isar/state_machine/state_machine.py,sha256=yud8FODucCFLVkK1E4NfKZ5YCrFb8IRfk752Nn_WTIY,22606
 isar/state_machine/states_enum.py,sha256=ks1A8gO7DOpLbSe6Vzq4-BfTCU78IsQZyoEJwQ9Wg4M,254
 isar/state_machine/states/__init__.py,sha256=gUikQDu-O-lmunwzwcN9gN6VaEmlCFlqqgdNfFAfXBc,189
 isar/state_machine/states/idle.py,sha256=tfciqI7NPDVF8WMe5qbSO3c-xDzUTQYLmJinb9e0JS8,1231
 isar/state_machine/states/initialize.py,sha256=Vx7OxWZI_xEkRwHWFh9ymxK_7mDH0Wayt09dGGqBJWk,2359
 isar/state_machine/states/initiate.py,sha256=b0Fq3tN6TZMg5j4192OsYdGbphTXWCkftBsFX57mhrw,5652
-isar/state_machine/states/monitor.py,sha256=2eYv2wUH0MLwxZCizBHIpigELPeou6KzCzW_JuEVlls,8612
+isar/state_machine/states/monitor.py,sha256=ykVQe54Lm_V-X7kJ16GMkycG7T9Kz3g2hsPtL35NSSk,9004
 isar/state_machine/states/off.py,sha256=jjqN_oJMpBtWuY7hP-c9f0w3p2CYCfe-NpmYHHPnmyI,544
 isar/state_machine/states/paused.py,sha256=xVZM9WMt90FTiP5forSlA3eJ5Vt9LzZYCFDQDPIocKA,1004
 isar/state_machine/states/stop.py,sha256=Sxdo4FGhxc2Pj91jidYtVIjpSNklbEf1sJYJ6x51HgE,3348
@@ -102,13 +102,13 @@ robot_interface/models/mission/task.py,sha256=bjp-m_Ak6tzgUIQvbGe90Mnwt6QhofTgFx
 robot_interface/models/robots/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
 robot_interface/models/robots/robot_model.py,sha256=pZQsqhn9hh6XE3EjMZhWMzYqg5oJ4CJ4CXeOASKvEf8,452
 robot_interface/telemetry/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
-robot_interface/telemetry/mqtt_client.py,sha256=56i_jCfg2CMe5fwefKxwW4GSpWvrDXo6Zwb7vBGTZ6k,2297
-robot_interface/telemetry/payloads.py,sha256=9EshERifjD1u8CwjSiV3NGuj0KuXnwblQNBsEWCh5c4,1336
+robot_interface/telemetry/mqtt_client.py,sha256=p82lvfCqLyBHQ2n4jhWGRNb0RktAn4ptL8FZkASGGl4,2753
+robot_interface/telemetry/payloads.py,sha256=eMK7mjZPsLY6yvu7AK-OcdvkeUpChzDrySDY7IjQ9RM,1464
 robot_interface/utilities/__init__.py,sha256=47DEQpj8HBSa-_TImW-5JCeuQeRkm5NMpJWZG3hSuFU,0
 robot_interface/utilities/json_service.py,sha256=nU2Q_3P9Fq9hs6F_wtUjWtHfl_g1Siy-yDhXXSKwHwg,1018
 robot_interface/utilities/uuid_string_factory.py,sha256=_NQIbBQ56w0qqO0MUDP6aPpHbxW7ATRhK8HnQiBSLkc,76
-isar-1.16.17.dist-info/LICENSE,sha256=3fc2-ebLwHWwzfQbulGNRdcNob3SBQeCfEVUDYxsuqw,14058
-isar-1.16.17.dist-info/METADATA,sha256=50txXV96ijDaWa6NcBmtj4tsfH3WohQJfoUPuv0F9PQ,14752
-isar-1.16.17.dist-info/WHEEL,sha256=GJ7t_kWBFywbagK5eo9IoUwLW6oyOeTKmQ-9iHFVNxQ,92
-isar-1.16.17.dist-info/top_level.txt,sha256=UwIML2RtuQKCyJJkatcSnyp6-ldDjboB9k9JgKipO-U,21
-isar-1.16.17.dist-info/RECORD,,
+isar-1.16.18.dist-info/LICENSE,sha256=3fc2-ebLwHWwzfQbulGNRdcNob3SBQeCfEVUDYxsuqw,14058
+isar-1.16.18.dist-info/METADATA,sha256=kVSluDGtKWU_oYcDkJvO9cv6OLUmVWBLH5gwV8sseug,14752
+isar-1.16.18.dist-info/WHEEL,sha256=GJ7t_kWBFywbagK5eo9IoUwLW6oyOeTKmQ-9iHFVNxQ,92
+isar-1.16.18.dist-info/top_level.txt,sha256=UwIML2RtuQKCyJJkatcSnyp6-ldDjboB9k9JgKipO-U,21
+isar-1.16.18.dist-info/RECORD,,

robot_interface/telemetry/mqtt_client.py

@@ -1,11 +1,15 @@
 import time
 from abc import ABCMeta, abstractmethod
 from queue import Queue
-from typing import Callable, Tuple
+from typing import Callable, Tuple, Type
+from datetime import datetime
+import json
 
 from robot_interface.models.exceptions.robot_exceptions import (
     RobotTelemetryException,
 )
+from robot_interface.telemetry.payloads import CloudHealthPayload
+from robot_interface.utilities.json_service import EnhancedJSONEncoder
 
 
 class MqttClientInterface(metaclass=ABCMeta):
@@ -61,17 +65,23 @@ class MqttTelemetryPublisher(MqttClientInterface):
         self.retain: bool = retain
 
     def run(self, isar_id: str, robot_name: str) -> None:
+        self.cloud_healt_topic: str = f"isar/{isar_id}/cloud_health"
+        topic: str
+        payload: str
+
         while True:
             try:
-                payload: str = self.telemetry_method(
-                    isar_id=isar_id, robot_name=robot_name
-                )
+                payload = self.telemetry_method(isar_id=isar_id, robot_name=robot_name)
+                topic = self.topic
             except RobotTelemetryException:
-                continue
+                payload = json.dumps(
+                    CloudHealthPayload(isar_id, robot_name, datetime.utcnow()),
+                    cls=EnhancedJSONEncoder,
+                )
+                topic = self.cloud_healt_topic
+
+            self.publish(topic=topic, payload=payload, qos=self.qos, retain=self.retain)
 
-            self.publish(
-                topic=self.topic, payload=payload, qos=self.qos, retain=self.retain
-            )
             time.sleep(self.interval)
 
     def publish(

robot_interface/telemetry/payloads.py

@@ -15,6 +15,13 @@ class TelemetryPayload:
     timestamp: datetime
 
 
+@dataclass
+class CloudHealthPayload:
+    isar_id: str
+    robot_name: str
+    timestamp: datetime
+
+
 @dataclass
 class TelemetryPosePayload(TelemetryPayload):
     pose: Pose
@@ -65,6 +72,7 @@ class RobotInfoPayload:
     video_streams: List[VideoStream]
     host: str
     port: int
+    capabilities: List[str]
     timestamp: datetime