The Common State Filter for SLAM

This paper presents the common state filter (CSF), a novel and efficient suboptimal multiple hypothesis slam (MHSLAM) method for Kalman Filter-based SLAM algorithms. Conventional MHSLAM algorithms require the entire vehicle and map state to be copied for each hypothesis. The CSF, by contrast, maintains a single, common instance of the vast majority of the map and only copies the map portion that varies substantially across different hypotheses. We demonstrate the performance of the algorithm on the Victoria Park data set.