Fastbot Advanced: Mixed-Criticality Autonomous Robot

This project focuses on the development of a differential drive robot - Fastbot, with a criticality in mind. The system is designed with lower/higher level architectures, utilizing an ESP32 for hard real-time motion control and safety, and an Orange Pi 5B (OPi) for high-level SLAM and Nonlinear Model Predictive Control (NMPC).

🚀 Project Goals

• Mixed-Criticality Execution: Separating safety-critical tasks (Tier 1) from computationally intensive SLAM (Tier 2).
• Deterministic Motion Control: Ensuring the PID loop and safety monitors are never interrupted by communication overhead.
• System Reliability: Self-healing communication loops and latching hardware fault states.
• Advanced Navigation: Implementing Stella-SLAM for visual localization and high-level trajectory control on a high-performance Linux environment.
• SLAM & Fusion: Stereo camera based SLAM fused with high-frequency wheel odometry and IMU.

---

System Architecture

The project is organized as a monorepo containing both the low-level firmware and the high-level ROS2 SLAM stack.

1. 🦾 Firmware (ESP32 - Tier 1: High Criticality)

The firmware is built using ESP-IDF. It leverages the dual-core architecture to isolate motor control from the micro-ROS transport layer communicating with uros agent through UART.

Core Logic Features:

• Dual-Core Isolation: Core 0 handles the 50Hz PID loop; Core 1 handles the micro-ROS communication.
• Atomic Safety Layer: Uses C11 atomics to share system status between cores without locks.
• Self-Healing Transport: A custom reconnection state machine that automatically restores the micro-ROS session if the Orange Pi reboots.
• Latching Stall Protection: Monitors "PWM Effort vs. Encoder Result" to kill motor power if a physical stall is detected.

Task Distribution Table

Task	Priority	Core	Input	Output	Destination	Criticality Role
PID Timer (ISR)	High	0	Encoder Ticks, Setpoints	PWM Signals	Motor Driver	Hard Real-time motor velocity regulation.
Safety Watchdog	High	0	cmd_vel timestamp	Motor Shutdown	Hardware Pins	Failsafe for communication loss.
Stall Monitor	High	0	Velocity vs PWM	system_status	Atomic Var	Prevents motor burnout/hardware damage.
micro-ROS Task	Medium	1	Agent Ping, cmd_vel	Odometry, Heartbeat	Orange Pi	Asynchronous telemetry and command bridge.
Reset Service	Medium	1	Trigger Request	SYSTEM_OK	Atomic Var	Software recovery from latching faults.

🛡️ Reliability & Static Analysis

To ensure execution safety and deterministic behavior, the firmware is validated against industry-standard rule sets:

• MISRA C:2012 / CERT C Compliance: Using cppcheck and clang-tidy (via cppcoreguidelines-*), the codebase is audited for undefined behavior, pointer safety, and integer overflows.
• Zero-Allocation Principle: Post-initialization, the Tier 1 control loops (PID, Safety Watchdog) avoid dynamic memory allocation (malloc/free) to prevent heap fragmentation and non-deterministic timing.
• Type Safety: Strict enforcement of fixed-width integers (uint32_t, etc.) and const-correctness to ensure cross-platform predictability between the ESP32 and Orange Pi.

---

2. 🧠 SLAM & Navigation (Orange Pi 5B - Tier 2: Medium Criticality)

🚧 Under Development

The high-level logic resides on an OPi running Armbian OS.