Trustia Level-4 Autonomous Navigation Architecture: Deterministic 3D NDT Pose-Graph SLAM with 400Hz ESKF and ISO 26262 ASIL-D MRM Safety Shield in GNSS-Denied Environments
This paper presents the mathematical foundations, system architecture, and empirical verification of the Trustia Level-4 autonomous driving core. Operating in severely GPS/GNSS-degraded or electronic-warfare (jamming/spoofing) environments, the architecture combines a high-speed 3D Normal Distributions Transform (NDT) scan-to-map point-cloud matching pipeline with a tightly coupled 400Hz Error-State Kalman Filter (ESKF) running on 6-DOF IMU and wheel-speed odometry. Motion planning is executed via a deterministic kinematic Hybrid A* search coupled with a high-bandwidth Pure Pursuit and Stanley lateral controller operating over CAN-FD bus topologies at latencies below 1.4 ms. Safety criticality is addressed through a dual-channel 1oo2D safety shield, an ISO 21448 SOTIF plausibility monitor, and an ISO 26262 ASIL-D Minimal Risk Maneuver (MRM) state machine enforcing a 50 ms watchdog. Across 1,357 automated unit and hardware-in-the-loop (HIL) integration tests, the software stack demonstrates 100% deterministic test passage, sub-decimeter trajectory tracking accuracy, and seamless adaptability between urban passenger robotaxis and defense unmanned ground vehicles (UGVs).
Authors
- Murat Furkan Bayram
Publication Details
- Journal
- Zenodo (CERN European Organization for Nuclear Research)
- Published
- 2026-11-20
- DOI
- https://doi.org/10.5281/zenodo.24393768
- Primary Topic
- Robotics and Sensor-Based Localization
- Type
- article
- Field-Weighted Citation Impact
- 0.00