Recursive scan-matching SLAM

This paper presents Scan-SLAM, a new generalization of simultaneous localization and mapping (SLAM). SLAM implementations based on extended Kalman filter (EKF) data fusion have traditionally relied on simple geometric models for defining landmarks. This limits EKF-SLAM to environments suited to such models and tends to discard much potentially useful data. The approach presented in this paper is a marriage of EKF-SLAM and scan correlation. Landmarks are no longer defined by analytical models; instead they are defined by templates composed of raw sensed data. These templates can be augmented as more data become available so that the landmark definition improves with time. A new generic observation model is derived that is generated by scan correlation, and this permits stochastic location estimation for landmarks with arbitrary shape within the Kalman filter framework. The statistical advantages of an EKF representation are augmented with the general applicability of scan matching. Scan matching also serves to enhance data association reliability by providing a shape metric for landmark disambiguation. Experimental results in an outdoor environment are presented which validate the algorithm.