Volume 22 Issue 7/8 - Publication Date: 1 July - August 2003
Special Issue on the 3rd International Conference on Field and Service Robotics
Constrained Initialization of the Simultaneous Localization and Mapping Algorithm
S. B. Williams, H. Durrant-Whyte Australian Centre for Field Robotics, J04, The University of Sydney, 2006, Australia and G. Dissanayake Department of Mechanical and Manufacturing Engineering, University of Technology Sydney, 2006, Australia

In this paper we present a novel feature initialization technique for the Simultaneous Localization and Mapping (SLAM) algorithm. The initialization scheme extends previous approaches for identifying new confirmed features and is shown to improve the steady-state performance of the filter by incorporating tentative features into the filter as soon as they are observed. Constraints are then applied between multiple feature estimates when a feature is confirmed. Observations that are subsequently deemed as spurious are removed from the state vector after an appropriate timeout. It is shown that information that would otherwise be lost can therefore be used consistently in the filter. Results of this algorithm applied to data collected using a submersible vehicle are also shown.

Return to Contents