Particle Filter SLAM with High Dimensional Vehicle Model

This work presents a particle filter (PF) method closely related to FastSLAM for solving the simultaneous localization and mapping (SLAM) problem. Using the standard FastSLAM algorithm, only low-dimensional vehicle models can be handled due to computational constraints. In this work an extra factorization of the problem is introduced that makes high-dimensional vehicle models computationally feasible. Results using experimental data from a UAV (helicopter) are presented. The algorithm fuses measurements from on-board inertial sensors (accelerometer and gyro), barometer, and vision in order to solve the SLAM problem