swarmit 0.2.0__py3-none-any.whl → 0.3.0__py3-none-any.whl

testbed/cli/main.py

@@ -3,426 +3,94 @@
 import logging
 import time
 
-from dataclasses import dataclass
-from enum import Enum
-
 import click
 import serial
 import structlog
-
-from tqdm import tqdm
-from cryptography.hazmat.primitives import hashes
-
+from dotbot.serial_interface import SerialInterfaceException, get_default_port
+from rich import print
 from rich.console import Console
-from rich.live import Live
-from rich.table import Table
-
-from dotbot.logger import LOGGER
-from dotbot.hdlc import hdlc_encode, HDLCHandler, HDLCState
-from dotbot.protocol import PROTOCOL_VERSION, ProtocolHeader
-from dotbot.serial_interface import (
-    SerialInterface,
-    SerialInterfaceException,
-    get_default_port,
+from rich.pretty import pprint
+
+from testbed.swarmit import __version__
+from testbed.swarmit.controller import (
+    CHUNK_SIZE,
+    Controller,
+    ControllerSettings,
+    ResetLocation,
+    print_start_status,
+    print_status,
+    print_stop_status,
+    print_transfer_status,
 )
 
+SERIAL_PORT_DEFAULT = get_default_port()
+BAUDRATE_DEFAULT = 1000000
 
-SERIAL_PORT = get_default_port()
-BAUDRATE = 1000000
-CHUNK_SIZE = 128
-HEADER = ProtocolHeader()
-
-
-class NotificationType(Enum):
-    """Types of notifications."""
-
-    SWARMIT_NOTIFICATION_STATUS = 0
-    SWARMIT_NOTIFICATION_OTA_START_ACK = 1
-    SWARMIT_NOTIFICATION_OTA_CHUNK_ACK = 2
-    SWARMIT_NOTIFICATION_EVENT_GPIO = 3
-    SWARMIT_NOTIFICATION_EVENT_LOG = 4
-
-
-class RequestType(Enum):
-    """Types of requests."""
-
-    SWARMIT_REQ_EXPERIMENT_START = 1
-    SWARMIT_REQ_EXPERIMENT_STOP = 2
-    SWARMIT_REQ_EXPERIMENT_STATUS = 3
-    SWARMIT_REQ_OTA_START = 4
-    SWARMIT_REQ_OTA_CHUNK = 5
-
-
-class StatusType(Enum):
-    """Types of device status."""
-
-    Ready = 0
-    Running = 1
-    Off = 2
-
-
-@dataclass
-class DataChunk:
-    """Class that holds data chunks."""
-
-    index: int
-    size: int
-    data: bytes
-
-
-def _header():
-    """Return the header for the protocol."""
-    buffer = bytearray()
-    for field in ProtocolHeader().fields:
-        buffer += int(field.value).to_bytes(
-            length=field.length, byteorder="little", signed=field.signed
-        )
-    buffer += int(16).to_bytes(length=1, byteorder="little")
-    return buffer
-
-
-class SwarmitFlash:
-    """Class used to flash a firmware."""
-
-    def __init__(self, port, baudrate, firmware, known_devices):
-        self.serial = SerialInterface(port, baudrate, self.on_byte_received)
-        self.hdlc_handler = HDLCHandler()
-        self.start_ack_received = False
-        self.firmware = bytearray(firmware.read()) if firmware is not None else None
-        self.known_devices = known_devices
-        self.last_acked_index = -1
-        self.chunks = []
-        self.fw_hash = None
-        self.acked_ids = []
-
-    def on_byte_received(self, byte):
-        self.hdlc_handler.handle_byte(byte)
-        if self.hdlc_handler.state == HDLCState.READY:
-            payload = self.hdlc_handler.payload[25:]
-            if not payload:
-                return
-            deviceid_ack = hex(int.from_bytes(payload[0:8], byteorder="little"))
-            if deviceid_ack not in self.acked_ids:
-                self.acked_ids.append(deviceid_ack)
-            if payload[8] == NotificationType.SWARMIT_NOTIFICATION_OTA_START_ACK.value:
-                self.start_ack_received = True
-            elif (
-                payload[8] == NotificationType.SWARMIT_NOTIFICATION_OTA_CHUNK_ACK.value
-            ):
-                self.last_acked_index = int.from_bytes(
-                    payload[9:14], byteorder="little"
-                )
-
-    def _send_start_ota(self, device_id):
-        buffer = bytearray()
-        buffer += _header()
-        buffer += int(device_id, 16).to_bytes(length=8, byteorder="little")
-        buffer += int(RequestType.SWARMIT_REQ_OTA_START.value).to_bytes(
-            length=1, byteorder="little"
-        )
-        buffer += len(self.firmware).to_bytes(length=4, byteorder="little")
-        buffer += self.fw_hash
-        self.serial.write(hdlc_encode(buffer))
-
-    def init(self, device_ids):
-        digest = hashes.Hash(hashes.SHA256())
-        chunks_count = int(len(self.firmware) / CHUNK_SIZE) + int(
-            len(self.firmware) % CHUNK_SIZE != 0
-        )
-        for chunk_idx in range(chunks_count):
-            if chunk_idx == chunks_count - 1:
-                chunk_size = len(self.firmware) % CHUNK_SIZE
-            else:
-                chunk_size = CHUNK_SIZE
-            data = self.firmware[
-                chunk_idx * CHUNK_SIZE : chunk_idx * CHUNK_SIZE + chunk_size
-            ]
-            digest.update(data)
-            self.chunks.append(
-                DataChunk(
-                    index=chunk_idx,
-                    size=chunk_size,
-                    data=data,
-                )
-            )
-        print(f"Radio chunks ({CHUNK_SIZE}B): {len(self.chunks)}")
-        self.fw_hash = digest.finalize()
-        if not device_ids:
-            print("Broadcast start ota notification...")
-            self._send_start_ota("0")
-            self.acked_ids = []
-            timeout = 0  # ms
-            while timeout < 10000 and sorted(self.acked_ids) != sorted(
-                self.known_devices
-            ):
-                timeout += 1
-                time.sleep(0.0001)
-        else:
-            self.acked_ids = []
-            for device_id in device_ids:
-                print(f"Sending start ota notification to {device_id}...")
-                self._send_start_ota(device_id)
-                timeout = 0  # ms
-                while timeout < 10000 and device_id not in self.acked_ids:
-                    timeout += 1
-                    time.sleep(0.0001)
-        return self.acked_ids
-
-    def send_chunk(self, chunk, device_id):
-        send_time = time.time()
-        send = True
-        tries = 0
-
-        def is_chunk_acknowledged():
-            if device_id == "0":
-                return self.last_acked_index == chunk.index and sorted(
-                    self.acked_ids
-                ) == sorted(self.known_devices)
-            else:
-                return (
-                    self.last_acked_index == chunk.index and device_id in self.acked_ids
-                )
-
-        self.acked_ids = []
-        while tries < 3:
-            if is_chunk_acknowledged():
-                break
-            if send is True:
-                buffer = bytearray()
-                buffer += _header()
-                buffer += int(device_id, 16).to_bytes(length=8, byteorder="little")
-                buffer += int(RequestType.SWARMIT_REQ_OTA_CHUNK.value).to_bytes(
-                    length=1, byteorder="little"
-                )
-                buffer += int(chunk.index).to_bytes(length=4, byteorder="little")
-                buffer += int(chunk.size).to_bytes(length=1, byteorder="little")
-                buffer += chunk.data
-                self.serial.write(hdlc_encode(buffer))
-                send_time = time.time()
-                tries += 1
-            time.sleep(0.001)
-            send = time.time() - send_time > 0.1
-        else:
-            raise Exception(f"chunk #{chunk.index} not acknowledged. Aborting.")
-        self.last_acked_index = -1
-        self.last_deviceid_ack = None
-
-    def transfer(self, device_ids):
-        data_size = len(self.firmware)
-        progress = tqdm(
-            range(0, data_size), unit="B", unit_scale=False, colour="green", ncols=100
-        )
-        progress.set_description(f"Loading firmware ({int(data_size / 1024)}kB)")
-        for chunk in self.chunks:
-            if not device_ids:
-                self.send_chunk(chunk, "0")
-            else:
-                for device_id in device_ids:
-                    self.send_chunk(chunk, device_id)
-            progress.update(chunk.size)
-        progress.close()
-
-
-class SwarmitStart:
-    """Class used to start an experiment."""
-
-    def __init__(self, port, baudrate, known_devices):
-        self.serial = SerialInterface(port, baudrate, lambda x: None)
-        self.known_devices = known_devices
-        self.hdlc_handler = HDLCHandler()
-        # Just write a single byte to fake a DotBot gateway handshake
-        self.serial.write(int(PROTOCOL_VERSION).to_bytes(length=1))
-
-    def _send_start(self, device_id):
-        buffer = bytearray()
-        buffer += _header()
-        buffer += int(device_id, 16).to_bytes(length=8, byteorder="little")
-        buffer += int(RequestType.SWARMIT_REQ_EXPERIMENT_START.value).to_bytes(
-            length=1, byteorder="little"
-        )
-        self.serial.write(hdlc_encode(buffer))
-
-    def start(self, device_ids):
-        if not device_ids:
-            self._send_start("0")
-        else:
-            for device_id in device_ids:
-                if device_id not in self.known_devices:
-                    continue
-                self._send_start(device_id)
-
-
-class SwarmitStop:
-    """Class used to stop an experiment."""
-
-    def __init__(self, port, baudrate, known_devices):
-        self.serial = SerialInterface(port, baudrate, lambda x: None)
-        self.known_devices = known_devices
-        self.hdlc_handler = HDLCHandler()
-        # Just write a single byte to fake a DotBot gateway handshake
-        self.serial.write(int(PROTOCOL_VERSION).to_bytes(length=1))
-
-    def _send_stop(self, device_id):
-        buffer = bytearray()
-        buffer += _header()
-        buffer += int(device_id, 16).to_bytes(length=8, byteorder="little")
-        buffer += int(RequestType.SWARMIT_REQ_EXPERIMENT_STOP.value).to_bytes(
-            length=1, byteorder="little"
-        )
-        self.serial.write(hdlc_encode(buffer))
-
-    def stop(self, device_ids):
-        if not device_ids:
-            self._send_stop("0")
-        else:
-            for device_id in device_ids:
-                if device_id not in self.known_devices:
-                    continue
-                self._send_stop(device_id)
-
-
-class SwarmitMonitor:
-    """Class used to monitor an experiment."""
-
-    def __init__(self, port, baudrate, device_ids):
-        self.logger = LOGGER.bind(context=__name__)
-        self.hdlc_handler = HDLCHandler()
-        self.serial = SerialInterface(port, baudrate, self.on_byte_received)
-        self.last_deviceid_notification = None
-        self.device_ids = device_ids
-        # Just write a single byte to fake a DotBot gateway handshake
-        self.serial.write(int(PROTOCOL_VERSION).to_bytes(length=1))
-
-    def on_byte_received(self, byte):
-        if self.hdlc_handler is None:
-            return
-        self.hdlc_handler.handle_byte(byte)
-        if self.hdlc_handler.state == HDLCState.READY:
-            payload = self.hdlc_handler.payload[25:]
-            if not payload:
-                return
-            deviceid = int.from_bytes(payload[0:8], byteorder="little")
-            if self.device_ids and deviceid not in self.device_ids:
-                return
-            event = payload[8]
-            timestamp = int.from_bytes(payload[9:13], byteorder="little")
-            data_size = int(payload[13])
-            data = payload[14 : data_size + 14]
-            logger = self.logger.bind(
-                deviceid=hex(deviceid),
-                notification=event,
-                time=timestamp,
-                data_size=data_size,
-                data=data,
-            )
-            if event == NotificationType.SWARMIT_NOTIFICATION_EVENT_GPIO.value:
-                logger.info(f"GPIO event")
-            elif event == NotificationType.SWARMIT_NOTIFICATION_EVENT_LOG.value:
-                logger.info(f"LOG event")
 
-    def monitor(self):
-        while True:
-            time.sleep(0.01)
-
-
-class SwarmitStatus:
-    """Class used to get the status of experiment."""
-
-    def __init__(self, port, baudrate):
-        self.logger = LOGGER.bind(context=__name__)
-        self.hdlc_handler = HDLCHandler()
-        self.last_deviceid_notification = None
-        self.status_data = {}
-        self.resp_ids = []
-        self.table = Table()
-        self.table.add_column("Device ID", style="magenta", no_wrap=True)
-        self.table.add_column("Status", style="green")
-        self.serial = SerialInterface(port, baudrate, self.on_byte_received)
-        # Just write a single byte to fake a DotBot gateway handshake
-        self.serial.write(int(PROTOCOL_VERSION).to_bytes(length=1))
-
-    def on_byte_received(self, byte):
-        if self.hdlc_handler is None:
-            return
-        self.hdlc_handler.handle_byte(byte)
-        if self.hdlc_handler.state == HDLCState.READY:
-            payload = self.hdlc_handler.payload[25:]
-            if not payload:
-                return
-            deviceid_resp = hex(int.from_bytes(payload[0:8], byteorder="little"))
-            if deviceid_resp not in self.resp_ids:
-                self.resp_ids.append(deviceid_resp)
-            event = payload[8]
-            if event == NotificationType.SWARMIT_NOTIFICATION_STATUS.value:
-                status = StatusType(payload[9])
-                self.status_data[deviceid_resp] = status
-                self.table.add_row(
-                    deviceid_resp,
-                    f'{"[bold cyan]" if status == StatusType.Running else "[bold green]"}{status.name}',
-                )
-
-    def status(self, display=True):
-        buffer = bytearray()
-        buffer += _header()
-        buffer += int("0", 16).to_bytes(length=8, byteorder="little")
-        buffer += int(RequestType.SWARMIT_REQ_EXPERIMENT_STATUS.value).to_bytes(
-            length=1, byteorder="little"
+@click.group(context_settings=dict(help_option_names=["-h", "--help"]))
+@click.version_option(version=__version__)
+@click.option(
+    "-p",
+    "--port",
+    default=SERIAL_PORT_DEFAULT,
+    help=f"Serial port to use to send the bitstream to the gateway. Default: {SERIAL_PORT_DEFAULT}.",
+)
+@click.option(
+    "-b",
+    "--baudrate",
+    default=BAUDRATE_DEFAULT,
+    help=f"Serial port baudrate. Default: {BAUDRATE_DEFAULT}.",
+)
+@click.option(
+    "-e",
+    "--edge",
+    is_flag=True,
+    default=False,
+    help="Use MQTT adapter to communicate with an edge gateway.",
+)
+@click.option(
+    "-d",
+    "--devices",
+    type=str,
+    default="",
+    help="Subset list of devices to interact with, separated with ,",
+)
+@click.pass_context
+def main(ctx, port, baudrate, edge, devices):
+    if ctx.invoked_subcommand != "monitor":
+        # Disable logging if not monitoring
+        structlog.configure(
+            wrapper_class=structlog.make_filtering_bound_logger(
+                logging.CRITICAL
+            ),
         )
-        self.serial.write(hdlc_encode(buffer))
-        timeout = 0  # ms
-        while timeout < 2000:
-            timeout += 1
-            time.sleep(0.0001)
-        if self.status_data and display is True:
-            with Live(self.table, refresh_per_second=4) as live:
-                live.update(self.table)
-                for device_id, status in self.status_data.items():
-                    if status != StatusType.Off:
-                        continue
-                    self.table.add_row(device_id, f"[bold red]{status.name}")
-        return self.status_data
+    ctx.ensure_object(dict)
+    ctx.obj["port"] = port
+    ctx.obj["baudrate"] = baudrate
+    ctx.obj["edge"] = edge
+    ctx.obj["devices"] = [e for e in devices.split(",") if e]
 
 
-def swarmit_flash(port, baudrate, firmware, yes, devices, ready_devices):
+@main.command()
+@click.option(
+    "-v",
+    "--verbose",
+    is_flag=True,
+    help="Print start result.",
+)
+@click.pass_context
+def start(ctx, verbose):
+    """Start the user application."""
     try:
-        experiment = SwarmitFlash(port, baudrate, firmware, ready_devices)
-    except (
-        SerialInterfaceException,
-        serial.serialutil.SerialException,
-    ) as exc:
-        console = Console()
-        console.print("[bold red]Error:[/] {exc}")
-        return False
-
-    start_time = time.time()
-    print(f"Image size: {len(experiment.firmware)}B")
-    print("")
-    if yes is False:
-        click.confirm("Do you want to continue?", default=True, abort=True)
-    ids = experiment.init(devices)
-    if (devices and sorted(ids) != sorted(devices)) or (
-        not devices and sorted(ids) != sorted(ready_devices)
-    ):
-        console = Console()
-        console.print(
-            "[bold red]Error:[/] some acknowledgment are missing "
-            f'({", ".join(sorted(set(ready_devices).difference(set(ids))))}). '
-            "Aborting."
+        settings = ControllerSettings(
+            serial_port=ctx.obj["port"],
+            serial_baudrate=ctx.obj["baudrate"],
+            mqtt_host="argus.paris.inria.fr",
+            mqtt_port=8883,
+            edge=ctx.obj["edge"],
+            devices=list(ctx.obj["devices"]),
         )
-        return False
-    try:
-        experiment.transfer(devices)
-    except Exception as exc:
-        console = Console()
-        console.print(f"[bold red]Error:[/] transfer of image failed: {exc}")
-        return False
-    print(f"Elapsed: {time.time() - start_time:.3f}s")
-    return True
-
-
-def swarmit_start(port, baudrate, devices, ready_devices):
-    try:
-        experiment = SwarmitStart(port, baudrate, ready_devices)
+        controller = Controller(settings)
     except (
         SerialInterfaceException,
         serial.serialutil.SerialException,
@@ -430,13 +98,44 @@ def swarmit_start(port, baudrate, devices, ready_devices):
         console = Console()
         console.print(f"[bold red]Error:[/] {exc}")
         return
-    experiment.start(devices)
-    print("Experiment started.")
+    if controller.ready_devices:
+        started = controller.start()
+        print_start_status(
+            sorted(started),
+            sorted(set(controller.ready_devices).difference(set(started))),
+        )
+        if verbose:
+            print("Started devices:")
+            pprint(started)
+            print("Not started devices:")
+            pprint(
+                sorted(set(controller.ready_devices).difference(set(started)))
+            )
+    else:
+        print("No device to start")
+    controller.terminate()
 
 
-def swarmit_stop(port, baudrate, devices, running_devices):
+@main.command()
+@click.option(
+    "-v",
+    "--verbose",
+    is_flag=True,
+    help="Print start result.",
+)
+@click.pass_context
+def stop(ctx, verbose):
+    """Stop the user application."""
     try:
-        experiment = SwarmitStop(port, baudrate, running_devices)
+        settings = ControllerSettings(
+            serial_port=ctx.obj["port"],
+            serial_baudrate=ctx.obj["baudrate"],
+            mqtt_host="argus.paris.inria.fr",
+            mqtt_port=8883,
+            edge=ctx.obj["edge"],
+            devices=list(ctx.obj["devices"]),
+        )
+        controller = Controller(settings)
     except (
         SerialInterfaceException,
         serial.serialutil.SerialException,
@@ -444,104 +143,80 @@ def swarmit_stop(port, baudrate, devices, running_devices):
         console = Console()
         console.print(f"[bold red]Error:[/] {exc}")
         return
-    experiment.stop(devices)
-    print("Experiment stopped.")
+    if controller.running_devices or controller.resetting_devices:
+        stopped = controller.stop()
+        print_stop_status(
+            sorted(stopped),
+            sorted(
+                set(
+                    controller.running_devices + controller.resetting_devices
+                ).difference(set(stopped))
+            ),
+        )
+        if verbose:
+            print("Started devices:")
+            pprint(stopped)
+            print("Not started devices:")
+            pprint(
+                sorted(
+                    set(
+                        controller.running_devices
+                        + controller.resetting_devices
+                    ).difference(set(stopped))
+                )
+            )
+    else:
+        print("No device to stop")
+    controller.terminate()
 
 
-def swarmit_monitor(port, baudrate, devices):
-    try:
-        experiment = SwarmitMonitor(port, baudrate, devices)
-    except (
-        SerialInterfaceException,
-        serial.serialutil.SerialException,
-    ) as exc:
-        console = Console()
-        console.print(f"[bold red]Error:[/] {exc}")
+@main.command()
+@click.argument(
+    "locations",
+    type=str,
+)
+@click.pass_context
+def reset(ctx, locations):
+    """Reset robots locations.
+
+    Locations are provided as '<device_id>:<x>,<y>-<device_id>:<x>,<y>|...'
+    """
+    devices = ctx.obj["devices"]
+    if not devices:
+        print("No devices selected.")
+        return
+    locations = {
+        location.split(':')[0]: ResetLocation(
+            pos_x=int(float(location.split(':')[1].split(',')[0]) * 1e6),
+            pos_y=int(float(location.split(':')[1].split(',')[1]) * 1e6),
+        )
+        for location in locations.split("-")
+    }
+    if sorted(devices) and sorted(locations.keys()) != sorted(devices):
+        print("Selected devices and reset locations do not match.")
         return
     try:
-        experiment.monitor()
-    except KeyboardInterrupt:
-        print("Stopping monitor.")
-
-
-def swarmit_status(port, baudrate, display=True):
-    try:
-        experiment = SwarmitStatus(port, baudrate)
+        settings = ControllerSettings(
+            serial_port=ctx.obj["port"],
+            serial_baudrate=ctx.obj["baudrate"],
+            mqtt_host="argus.paris.inria.fr",
+            mqtt_port=8883,
+            edge=ctx.obj["edge"],
+            devices=list(ctx.obj["devices"]),
+        )
+        controller = Controller(settings)
     except (
         SerialInterfaceException,
         serial.serialutil.SerialException,
     ) as exc:
         console = Console()
         console.print(f"[bold red]Error:[/] {exc}")
-        return {}
-    result = experiment.status(display)
-    experiment.serial.stop()
-    return result
-
-
-@click.group()
-@click.option(
-    "-p",
-    "--port",
-    default=SERIAL_PORT,
-    help=f"Serial port to use to send the bitstream to the gateway. Default: {SERIAL_PORT}.",
-)
-@click.option(
-    "-b",
-    "--baudrate",
-    default=BAUDRATE,
-    help=f"Serial port baudrate. Default: {BAUDRATE}.",
-)
-@click.option(
-    "-d",
-    "--devices",
-    type=str,
-    default="",
-    help=f"Subset list of devices to interact with, separated with ,",
-)
-@click.pass_context
-def main(ctx, port, baudrate, devices):
-    if ctx.invoked_subcommand != "monitor":
-        # Disable logging if not monitoring
-        structlog.configure(
-            wrapper_class=structlog.make_filtering_bound_logger(logging.CRITICAL),
-        )
-    ctx.ensure_object(dict)
-    ctx.obj["port"] = port
-    ctx.obj["baudrate"] = baudrate
-    ctx.obj["devices"] = [e for e in devices.split(",") if e]
-
-
-@main.command()
-@click.pass_context
-def start(ctx):
-    known_devices = swarmit_status(ctx.obj["port"], ctx.obj["baudrate"], display=False)
-    ready_devices = sorted(
-        [
-            device
-            for device, status in known_devices.items()
-            if status == StatusType.Ready
-        ]
-    )
-    swarmit_start(
-        ctx.obj["port"], ctx.obj["baudrate"], list(ctx.obj["devices"]), ready_devices
-    )
-
-
-@main.command()
-@click.pass_context
-def stop(ctx):
-    known_devices = swarmit_status(ctx.obj["port"], ctx.obj["baudrate"], display=False)
-    running_devices = sorted(
-        [
-            device
-            for device, status in known_devices.items()
-            if status == StatusType.Running
-        ]
-    )
-    swarmit_stop(
-        ctx.obj["port"], ctx.obj["baudrate"], list(ctx.obj["devices"]), running_devices
-    )
+        return
+    if not controller.ready_devices:
+        print("No device to reset.")
+        return
+    controller.reset(locations)
+    controller.terminate()
 
 
 @main.command()
@@ -557,55 +232,146 @@ def stop(ctx):
     is_flag=True,
     help="Start the firmware once flashed.",
 )
-@click.argument("firmware", type=click.File(mode="rb", lazy=True), required=False)
+@click.option(
+    "-v",
+    "--verbose",
+    is_flag=True,
+    help="Print transfer data.",
+)
+@click.argument("firmware", type=click.File(mode="rb"), required=False)
 @click.pass_context
-def flash(ctx, yes, start, firmware):
+def flash(ctx, yes, start, verbose, firmware):
+    """Flash a firmware to the robots."""
     console = Console()
     if firmware is None:
         console.print("[bold red]Error:[/] Missing firmware file. Exiting.")
         ctx.exit()
-    known_devices = swarmit_status(ctx.obj["port"], ctx.obj["baudrate"], display=False)
-    ready_devices = sorted(
-        [
-            device
-            for device, status in known_devices.items()
-            if status == StatusType.Ready
-        ]
+
+    fw = bytearray(firmware.read())
+    settings = ControllerSettings(
+        serial_port=ctx.obj["port"],
+        serial_baudrate=ctx.obj["baudrate"],
+        mqtt_host="argus.paris.inria.fr",
+        mqtt_port=8883,
+        edge=ctx.obj["edge"],
+        devices=ctx.obj["devices"],
     )
-    if not ready_devices:
+    controller = Controller(settings)
+    if not controller.ready_devices:
+        console.print("[bold red]Error:[/] No ready devices found. Exiting.")
+        controller.terminate()
         return
-    if (
-        swarmit_flash(
-            ctx.obj["port"],
-            ctx.obj["baudrate"],
-            firmware,
-            yes,
-            list(ctx.obj["devices"]),
-            ready_devices,
-        )
-        is False
+    print(
+        f"Devices to flash ([bold white]{len(controller.ready_devices)}):[/]"
+    )
+    pprint(controller.ready_devices, expand_all=True)
+    if yes is False:
+        click.confirm("Do you want to continue?", default=True, abort=True)
+
+    devices = controller.settings.devices
+    start_data = controller.start_ota(fw)
+    if (devices and sorted(start_data.ids) != sorted(devices)) or (
+        not devices
+        and sorted(start_data.ids) != sorted(controller.ready_devices)
     ):
-        return
+        console = Console()
+        console.print(
+            "[bold red]Error:[/] some acknowledgments are missing "
+            f'({", ".join(sorted(set(controller.ready_devices).difference(set(start_data.ids))))}). '
+            "Aborting."
+        )
+        raise click.Abort()
+    print()
+    print(f"Image size: [bold cyan]{len(fw)}B[/]")
+    print(f"Image hash: [bold cyan]{start_data.fw_hash.hex().upper()}[/]")
+    print(f"Radio chunks ([bold]{CHUNK_SIZE}B[/bold]): {start_data.chunks}")
+    start_time = time.time()
+    data = controller.transfer(fw)
+    print(f"Elapsed: [bold cyan]{time.time() - start_time:.3f}s[/bold cyan]")
+    print_transfer_status(data, start_data)
+    if verbose:
+        pprint(data)
+    if not all([value.hashes_match for value in data.values()]):
+        controller.terminate()
+        console = Console()
+        console.print("[bold red]Error:[/] Hashes do not match.")
+        raise click.Abort()
+
     if start is True:
-        swarmit_start(
-            ctx.obj["port"],
-            ctx.obj["baudrate"],
-            list(ctx.obj["devices"]),
-            ready_devices,
+        started = controller.start()
+        print_start_status(
+            sorted(started),
+            sorted(set(start_data.ids).difference(set(started))),
         )
+    controller.terminate()
 
 
 @main.command()
 @click.pass_context
 def monitor(ctx):
-    swarmit_monitor(ctx.obj["port"], ctx.obj["baudrate"], ctx.obj["devices"])
+    """Monitor running applications."""
+    try:
+        settings = ControllerSettings(
+            serial_port=ctx.obj["port"],
+            serial_baudrate=ctx.obj["baudrate"],
+            mqtt_host="argus.paris.inria.fr",
+            mqtt_port=8883,
+            edge=ctx.obj["edge"],
+            devices=ctx.obj["devices"],
+        )
+        controller = Controller(settings)
+    except (
+        SerialInterfaceException,
+        serial.serialutil.SerialException,
+    ) as exc:
+        console = Console()
+        console.print(f"[bold red]Error:[/] {exc}")
+        return {}
+    try:
+        controller.monitor()
+    except KeyboardInterrupt:
+        print("Stopping monitor.")
+    finally:
+        controller.terminate()
 
 
 @main.command()
 @click.pass_context
 def status(ctx):
-    if not swarmit_status(ctx.obj["port"], ctx.obj["baudrate"]):
+    """Print current status of the robots."""
+    settings = ControllerSettings(
+        serial_port=ctx.obj["port"],
+        serial_baudrate=ctx.obj["baudrate"],
+        mqtt_host="argus.paris.inria.fr",
+        mqtt_port=8883,
+        edge=ctx.obj["edge"],
+        devices=ctx.obj["devices"],
+    )
+    controller = Controller(settings)
+    data = controller.status()
+    if not data:
         click.echo("No devices found.")
+    else:
+        print_status(data)
+    controller.terminate()
+
+
+@main.command()
+@click.argument("message", type=str, required=True)
+@click.pass_context
+def message(ctx, message):
+    """Send a custom text message to the robots."""
+    settings = ControllerSettings(
+        serial_port=ctx.obj["port"],
+        serial_baudrate=ctx.obj["baudrate"],
+        mqtt_host="argus.paris.inria.fr",
+        mqtt_port=8883,
+        edge=ctx.obj["edge"],
+        devices=ctx.obj["devices"],
+    )
+    controller = Controller(settings)
+    controller.send_message(message)
+    controller.terminate()
 
 
 if __name__ == "__main__":