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

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
Controls
|||
ALL TIME
JAN
FEB
MAR
APR
MAY
JUN
JUL
AUG
SEP
OCT
NOV
article

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

Murat Furkan Bayram
2 links
Zenodo (CERN European Organization for Nuclear Research)
Robotics and Sensor-Based Localization
article

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

Murat Furkan Bayram
article en

Abstract

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).

Zenodo (CERN European Organization for Nuclear Research)
Industry, innovation and infrastructure
Robotics and Sensor-Based Localization
AI Navigator

Ask Laika to Summarize, Analyze, and Connect papers live on the map.

Summarize Papers & Methodologies

Extract key findings, datasets, and comparative methods across publications.

Benchmark Rankings & Visual Analytics

Rank top research institutions, authors, funders, topics, and journals by Field-Weighted Citation Impact (FWCI) and paper volume with instant charts.

Connect Distant Disciplines

Bridge topological clusters on the map to find hidden collaborative intersections.

Laika access coming soon
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 — Murat Furkan Bayram · Zenodo (CERN European Organization for Nuclear Research) (2026) | TGRS Research Map | TGRS