Abstract:This work develops a sliding window filter for incremental simultaneous localization and mapping (SLAM) that focuses computational resources on accurately estimating the immediate spatial surroundings using a sliding time window of the most recent sensor measurements. Ideally, we would like a constant time algorithm that closely approximates the all-time maximum-likelihood estimate as well as the minimum variance Cramer Rao lower bound (CRLB) - that is we would like an estimator that achieves some notion of statistical optimality (quickly converges), efficiency (quickly reduces uncertainty) and consistency (avoids over-confidence). To this end we give a derivation of the SLAM problem from the Gaussian non-linear least squares optimization perspective.We find that this results in a simple, yet general, take on the SLAM problem; we think this is a useful contribution.Our approach is inspired by the results from the photogrammetry community, dating back to the late 1950’s [1], and later derivatives like Mikhail’s least squares treatment [6], the Variable state dimension filter(VSDF) [5], visual odometry( VO) [4], modern bundle adjustment(BA) [10, 3] and of course extended Kalman filter (EKF) SLAM [9].We apply the sliding window filter to SLAM with stereo vision and inertial measurements. Experiments show that the best approximate method comes close to matching the performance of the optimal estimator while attaining constant time complexity - empirically, it is often the case that the difference in their performance is indistinguishable.

A FastSLAM Algorithm Based on the Auxiliary Particle Filter with Stirling Interpolation

A FastSLAM Algorithm Based on the Improved Auxiliary Particle Filter with Stirling Interpolation

An Improved Transformed Unscented FastSLAM with Adaptive Genetic Resampling

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

Adaptive Square-Root Transformed Unscented FastSLAM with KLD-resampling

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

LS-SLAM: SLAM with Lebesgue Sampling

Fast SLAM algorithm based on central difference Kalman filter

Stereo Vision Based SLAM Using Rao-Blackwellised Particle Filter

An Improved FastSLAM Algorithm Based on Revised Genetic Resampling and SR-UPF

Stereo Vision Based SLAM in Outdoor Environments

An Improved Adaptive Unscented FastSLAM with Genetic Resampling

Fast Gaussian particle filtering algorithm

Improved FastSLAM Algorithm Based on Importance Weight Smoothing

An Improved UFastSLAM With Generalized Correntropy Loss and Adaptive Genetic Resampling

FSD-SLAM: a fast semi-direct SLAM algorithm

GAPSLAM: Blending Gaussian Approximation and Particle Filters for Real-Time Non-Gaussian SLAM

Local Optimized and Scalable Frame-to-model SLAM

A UPF-PS SLAM Algorithm for Indoor Mobile Robot with NonGaussian Detection Model

A Fast and Stable GNSS-LiDAR-Inertial State Estimator from Coarse to Fine by Iterated Error-State Kalman Filter

A Sliding Window Filter for Incremental SLAM