An efficient approach to the simultaneous localisation and mapping problem

Abstract

This paper presents a novel approach to the simultaneous localisation and mapping algorithm that exploits the manner in which observations are fused into the global map of the environment to manage the computational complexity of the algorithm and improve the data association process. Rather than incorporating every observation directly into the global map of the environment, the constrained local submap filter relies on creating an independent, local submap of the features in the immediate vicinity of the vehicle. This local submap is then periodically fused into the global map of the environment using appropriately formulated constraints between the common feature estimates. This approach is shown to be effective in reducing the computational complexity of maintaining the global map estimates as well as improving the data association process.