Reliable localization and mapping in GPS-denied and perceptually degraded environments remain critical challenges for autonomous robotic systems, particularly in subterranean settings characterized by smoke, dust, low visibility, extreme temperatures, and uneven terrain. These challenges are further exacerbated by the difficulty of identifying temporal sensor failures, which are not effectively handled by single Kalman filter implementations or conventional centralized fusion architectures. In such cases, erroneous measurements can propagate through the estimation process and degrade overall fusion performance. Moreover, existing decentralized fusion approaches often fail to fully prevent corrupted measurements from influencing the final state estimates. To address these limitations, this thesis introduces a Fault Resilient Optimal Information Filter (FROIF), integrated with both classical and learning based fault detection mechanisms. The proposed framework adopts a multi-layer decentralized fusion strategy to improve robustness across ground, aerial, and space robotic platforms. A threshold based validation mechanism is applied at each time step to identify faulty sensor measurements. Based on this detection outcome, the FROIF framework eliminates the contribution of corrupted sensor estimates and their associated covariances from the final fusion stage, ensuring that faulty measurements do not influence the global estimate. In contrast, existing methods typically reduce the impact of such measurements rather than fully removing them. Collectively, the proposed frameworks enhance fault resilience and reliability in multi-sensor fusion. Furthermore, an autoencoder based approach is introduced to evaluate and compare classical and learning based fault detection methods within both centralized and decentralized fusion architectures.
Within multi sensor fusion pipelines, smoke and fog are observed to be the dominant causes of LiDAR failure. Consequently, this thesis focuses on radar inertial odometry as a complementary modality to improve robustness in degraded environments. Initially, cost-effective mmWave radars with a Pixhawk IMU are used, with multi-directional radars mounted on a ground mobile platform. During experiments in Sub-T with these sensors, it was found that the IMUs exhibit dynamical acceleration bias in the presence of extreme cold and tunnel slopes in a ground mobile robot, where the x component of the gravity vector is projected onto the acceleration of the vehicle along the forward axis, thereby introducing a dynamical bias in the measured acceleration. In addition, radar point clouds differ fundamentally from LiDAR data, being inherently sparse, noisy, and prone to flickering effects, which further complicates achieving stable and reliable odometry with prior EKF-RIO frameworks. To address these challenges, this thesis presents a novel two-stage multi-radar inertial odometry (MRIO) framework for resilient localization and mapping in GPS-denied subterranean environments. In the first stage, radar ego-velocity estimation, formulated through a least-squares approach, is incorporated into an Extended Kalman Filter (EKF) for IMU bias correction. The resulting drift free accelerations are then fused in the second stage with measurements from multiple radars and the IMU to refine odometry performance. Beyond odometry, the framework also supports radar based mapping by leveraging the robot's translational and angular displacement. Starting with a range based outlier filter and least-squares ego-velocity reconstruction, the MRIO framework enables robust ego-velocity estimation, localization, and mapping using radar and IMU measurements. The proposed methods are extensively validated through real-world experiments in GPS-denied subterranean tunnels, including smoke-filled environments and long-duration trajectories. Experimental results demonstrate significant improvements in localization accuracy, drift reduction, and robustness compared to prior radar inertial odometry approaches.
Since LiDAR provides accurate geometric information under nominal conditions but degrades in the presence of smoke, dust, and other airborne obscurants, this thesis investigates LiDAR radar fusion through two complementary formulations. The first employs proactive LiDAR degradation detection for reliability-aware adaptive localization, while the second uses decentralized fault resilient fusion with adaptive residual thresholding to identify and isolate unreliable estimates. In the first formulation, LiDAR-inertial odometry (LIO) serves as the primary localization modality, whereas radar inertial odometry (RIO) provides a more robust alternative under degraded visibility. LiDAR reliability is estimated using a one-class temporal learning framework that combines degradation sensitive spatial, geometric, motion, cross-modal, intensity, and measurement recency features. These features are arranged over sliding temporal windows and processed by an LSTM autoencoder trained exclusively on nominal LiDAR data, enabling degradation to be detected without labelled failure examples. The resulting reconstruction error is used as a reliability indicator: LIO based localization is considered during nominal operation, while localization switches to RIO when LiDAR degradation or measurement loss is detected. The framework is evaluated on real-world ground-robot datasets collected in GNSS-denied subterranean tunnels under nominal and dense-smoke conditions, demonstrating effective degradation detection, adaptive LIO-RIO switching, and continued localization during severe LiDAR impairment. An ablation study further shows that a reduced feature set can improve performance in dense smoke scenarios, highlighting the importance of feature parsimony in one-class sensor health monitoring.
Luleå: Luleå University of Technology, 2026.