An improved FastSLAM 2.0 algorithm based on FC&ASD-PSO

摘要

FastSLAM 2.0 is a popular framework which uses a Rao-Blackwellized particle filter to solve the simultaneous localization and mapping problem. The sampling process is one of the most important phases in the FastSLAM 2.0 framework. Its estimation accuracy depends heavily on a correct prior knowledge about the control and observation noise statistics (the covariance matrices Q and R). Without the correct prior knowledge about these matrices, the estimation accuracy of the robot path and landmark positions may degrade seriously. However in many applications, the prior knowledge is unknown, or these noises are non-stationary. In this paper, these covariance matrices are supposed to be dynamic and denoted as Q(t) and R-t. Since there are noises, time-adjacent observations are inconsistent with each other. This inconsistency can reflect the real value of the covariance matrices. By the inconsistency, an extra step is introduced to the FastSLAM 2.0 framework. This step makes Q(t) and R-t match with their real value by using a particle swarm optimization method based on fractional calculus and alpha stable distribution (FC&ASD-PSO). Both simulation and experimental results show that the proposed algorithm improves the accuracy by the more accurate estimation on the noise covariance matrices.