Abstract:Point set registration is an important problem in Simultaneous Localization And Mapping (SLAM). In this paper, a novel registration algorithm based on Cubature Kalman Filter (CKF) is proposed. First, the state space model (SSM) regarding two point sets with Gaussian noise is formulated. Then CKF and simulated annealing based algorithm is utilized to optimize the process recursively. Since point set registration problem in SLAM application is mainly 3D, algorithm proposed in this paper focuses on 3D rigid point set registration problem. Compared to classical method, like Iterative Closest Point (ICP), CKF based method is more robust to noise and outliers. Besides that, this algorithm does not depend much on proper initialization which is very important to ICP. In order to explore the state space more efficiently, continuous simulated annealing is used on the process noise. Compared to Unscented Kalman Filter (UKF) based registration algorithm, this algorithm can improve precision of approximating nonlinearity in measurement update. So it will converge to the desired minimum more quickly, which is very important to SLAM considering real-time requirement. Experiments on SLAM dataset validate good performance of CKF based algorithm. The results also demonstrate the proposed method outperforms ICP and UKF based methods in the presence of noise, outliers and initial misalignment.

Adaptive SLAM Algorithm with Sampling Based on State Uncertainty

LS-SLAM: SLAM with Lebesgue Sampling

An Improved Transformed Unscented FastSLAM with Adaptive Genetic Resampling

Algorithm for Mobile Robots' Simultaneous Localization and Mapping in Unknown Environments

Adaptive Square-Root Transformed Unscented FastSLAM with KLD-resampling

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

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

An Improved Adaptive Unscented FastSLAM with Genetic Resampling

Robust Variational Bayesian Adaptive Cubature Kalman Filtering Algorithm for Simultaneous Localization and Mapping with Heavy-Tailed Noise

Comparing EKF and SPKF Algorithms for Simultaneous Localization and Mapping (SLAM)

Batch SLAM with PMBM Data Association Sampling and Graph-Based Optimization

Robust Monocular SLAM Towards Motion Disturbance

A SLAM algorithm based on the central difference Kalman filter

Simultaneous Localization And Mapping Embedded With Particle Filter Algorithm

Unscented SLAM with Conditional Iterations

A Novel Robust Approach for SLAM of Mobile Robot

UncLe-SLAM: Uncertainty Learning for Dense Neural SLAM

SLAM method for mobile robot in unknown environment

Ant system based state estimation approach to SLAM

Cubature Kalman Filter Based Point Set Registration for 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