Abstract:Simultaneous localization and mapping (SLAM) faces significant challenges due to high computational costs, low accuracy, and instability, which are particularly problematic because SLAM systems often operate in real-time environments where timely and precise state estimation is crucial. High computational costs can lead to delays, low accuracy can result in incorrect mapping and localization, and instability can make the entire system unreliable, especially in dynamic or complex environments. As the state-space dimension increases, the filtering error of the standard cubature Kalman filter (CKF) grows, leading to difficulties in multiplicative noise propagation and instability in state estimation results. To address these issues, this paper proposes an extended-dimensional embedded CKF based on truncated singular-value decomposition (TSVD-AECKF). Firstly, singular-value decomposition (SVD) is employed instead of the Cholesky decomposition in the standard CKF to mitigate the non-positive definiteness of the state covariance matrix. Considering the effect of small singular values on the stability of state estimation, a method is provided to truncate singular values by determining the truncation threshold using the Akaike information criterion (AIC). Furthermore, the system noise is embedded into the state variables, and an embedding volume criterion is used to improve the conventional CKF while extending the dimensionality. Finally, the proposed algorithm was validated and analyzed through both simulations and real-world experiments. The results indicate that the proposed method effectively mitigates the increase in localization error as the state-space dimension grows, enhancing time efficiency by 55.54%, and improving accuracy by 35.13% compared to the standard CKF algorithm, thereby enhancing the robustness and stability of mapping.

Slam And Moving Target Tracking Based On Constrained Local Submap Filter

Intelligent Filter-Based Slam For Mobile Robots With Improved Localization Performance

Simultaneous localization and map building with linear system model.

Stereo Vision Based SLAM Using Rao-Blackwellised Particle Filter

Robot SLAM algorithm based on laser range finder for large scale environment

Local Optimized and Scalable Frame-to-model SLAM

An Enhanced Multi-Sensor Simultaneous Localization and Mapping (SLAM) Framework with Coarse-to-Fine Loop Closure Detection Based on a Tightly Coupled Error State Iterative Kalman Filter

RGB‐D SLAM with Moving Object Tracking in Dynamic Environments

Enhanced Unscented Kalman Filter-Based SLAM in Dynamic Environments: Euclidean Approach

EKF-SLAM Algorithm with Constraints

A New Solution to SLAM Problem Based on Local Map Matching

Conditional simultaneous localization and mapping: A robust visual SLAM system

A NOVEL MAP BUILDING METHOD AND EKF BASED LOCALIZATION FOR MOBILE ROBOT

Dynamic simultaneous localization and mapping based on object tracking in occluded environment

A Geometric Nonlinear Stochastic Filter for Simultaneous Localization and Mapping

A Wavelet Transform Assisted Extended Kalman Filter-Based Approach for Simultaneous Localization and Mapping Problems

Vision Based Mapping And Localization In Unknown Environment For Intelligent Mobile Robot

Simultaneous Localization and Mapping: Through the Lens of Nonlinear Optimization

Accurate Monocular Visual-inertial SLAM using a Map-assisted EKF Approach

SLAM Backends with Objects in Motion: A Unifying Framework and Tutorial

An Investigation of Extended-Dimension Embedded CKF-SLAM Based on the Akaike Information Criterion