Bearing-only landmark initialization with unknown data association

It is essential in many applications that mobile robots localize themselves with respect to an unknown environment. This means that the robot must build a map of its environment and then localize using the map. This process is called simultaneous localization and mapping (SLAM). This paper presents an iterative solution to the landmark initialization problem inherent in a bearing-only implementation of SLAM. No prior knowledge of the environment is required, and furthermore, there are no requirements about having the data association problem solved. Once landmarks are initialized, they are inserted into an extended Kalman Filter (EKF) to solve the SLAM problem. Both indoor and outdoor experiments are presented to validate the method.

[1]  Greg Welch,et al.  Welch & Bishop , An Introduction to the Kalman Filter 2 1 The Discrete Kalman Filter In 1960 , 1994 .

[2]  Wolfram Burgard,et al.  Particle Filters for Mobile Robot Localization , 2001, Sequential Monte Carlo Methods in Practice.

[3]  Stefan B. Williams,et al.  Constrained Initialization of the Simultaneous Localization and Mapping Algorithm , 2003, Int. J. Robotics Res..

[4]  Hugh F. Durrant-Whyte,et al.  Simultaneous map building and localization for an autonomous mobile robot , 1991, Proceedings IROS '91:IEEE/RSJ International Workshop on Intelligent Robots and Systems '91.

[5]  Martial Hebert,et al.  Bearings-only localization and mapping , 2005 .

[6]  Randall Smith,et al.  Estimating Uncertain Spatial Relationships in Robotics , 1987, Autonomous Robot Vehicles.

[7]  Wolfram Burgard,et al.  A Probabilistic Approach to Concurrent Mapping and Localization for Mobile Robots , 1998, Auton. Robots.

[8]  Hugh F. Durrant-Whyte,et al.  A solution to the simultaneous localization and map building (SLAM) problem , 2001, IEEE Trans. Robotics Autom..

[9]  Tim Bailey.  Constrained initialisation for bearing-only SLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[10]  Frank Dellaert,et al.  Structure from motion without correspondence , 2000, Proceedings IEEE Conference on Computer Vision and Pattern Recognition. CVPR 2000 (Cat. No.PR00662).

[11]  N. Nathan.  Self and will , 1997 .

[12]  Peter Cheeseman,et al.  On the Representation and Estimation of Spatial Uncertainty , 1986 .

[13]  Frank Dellaert,et al.  Linear 2D localization and mapping for single and multiple robot scenarios , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[14]  Stergios I. Roumeliotis,et al.  Bayesian estimation and Kalman filtering: a unified framework for mobile robot localization , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[15]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.

[16]  E. Nebot,et al.  Bearing-only SLAM using colour-based feature tracking , 2002 .