Adds basic hitl module

Author: honzikschenk

modules/hitl/__init__.py

@@ -0,0 +1,18 @@
+"""
+Emulates camera input to PI.
+"""
+
+
+class CameraEmulator:
+    """
+    Setup for camera emulator.
+    """
+
+    def create(self) -> "tuple[True, CameraEmulator] | tuple[False, None]":
+        """
+        Setup camera emulator.
+
+        Returns:
+            Success, CameraEmulator instance.
+        """
+        return True, self

modules/hitl/camera_emulator.py

@@ -0,0 +1,69 @@
+"""
+Setup for HITL modules.
+"""
+
+from modules.mavlink.flight_controller import FlightController
+
+from modules.hitl.position_emulator import PositionEmulator
+from modules.hitl.camera_emulator import CameraEmulator
+
+
+class HITL:
+    """
+    Hardware In The Loop (HITL) setup for emulating drone hardware.
+    Provides a way to emulate the drone's position and camera input
+    for testing purposes without needing actual hardware.
+    """
+
+    __create_key = object()
+
+    @classmethod
+    def create(
+        cls, drone: FlightController, camera_module: bool
+    ) -> "tuple[True, HITL] | tuple[False, None]":
+        """
+        Setup workers for.
+
+        Args:
+            drone: The FlightController instance for the drone.
+            camera_module: Boolean indicating if the camera module is enabled.
+
+        Returns:
+            Success, HITL instance.
+        """
+        if not isinstance(drone, FlightController):
+            return False, None
+
+        position_emulator = PositionEmulator()
+        result, position_emulator = position_emulator.create(drone)
+        if not result:
+            return False, None
+
+        if camera_module:
+            camera_emulator = CameraEmulator()
+            result, camera_emulator = camera_emulator.create()
+            if not result:
+                return False, None
+
+        hitl = HITL(
+            cls.__create_key, drone, position_emulator, camera_emulator if camera_module else None
+        )
+
+        return True, hitl
+
+    def __init__(
+        self,
+        class_private_create_key: object,
+        drone: FlightController,
+        position_emulator: "PositionEmulator",
+        camera_emulator: "CameraEmulator | None" = None,
+    ) -> None:
+        """
+        Private constructor, use create() method.
+        """
+        assert class_private_create_key is HITL.__create_key, "Use create() method"
+
+        self.drone = drone
+
+        self.position_emulator = position_emulator
+        self.camera_emulator = camera_emulator

modules/hitl/hitl_base.py

@@ -0,0 +1,22 @@
+"""
+Emulates position and attitude to Pixhawk.
+"""
+
+from modules.mavlink.flight_controller import FlightController
+
+
+class PositionEmulator:
+    """
+    Setup for position emulator.
+    """
+
+    def create(
+        self, drone: FlightController
+    ) -> "tuple[True, PositionEmulator] | tuple[False, None]":
+        """
+        Setup position emulator.
+
+        Returns:
+            Success, PositionEmulator instance.
+        """
+        return True, self