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.

Positive definiteness analysis of the covariance matrix in EKF-SLAM

Simultaneous localization and map building with linear system model.

Consistency Analysis of EKF-SLAM for a Basic Scenario

Improving the Robustness to the Uncertainty of Initial Depth Estimation in Monocular SLAM

Robust SLAM using square-root cubature Kalman filter and Huber’ s GM-estimator

Em-Based Point to Plane Icp for 3d Simultaneous Localization and Mapping

Consistent Right-Invariant Fixed-Lag Smoother with Application to Visual Inertial SLAM

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

EKF-SLAM Algorithm with Constraints

A SLAM algorithm based on the central difference Kalman filter

Conditional simultaneous localization and mapping: A robust visual SLAM system

A Right Invariant Extended Kalman Filter for Object Based SLAM

An Adaptive Invariant EKF for Map-Aided Localization Using 3D Point Cloud

Notes on Various Errors and Jacobian Derivations for SLAM

Lidar Scan Matching EKF-SLAM Using the Differential Model of Vehicle Motion.

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

Unscented SLAM with Conditional Iterations

Monocular Simultaneous Localization and Mapping with a Modified Covariance Extended Kalman Filter

Analysis of the Consistency of EKF-based SLAM

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

A calibration method for non-positive definite covariance matrix in multivariate data analysis