Integrating Multiple Scan Matching Results for Ego-Motion Estimation with Uncertainty

This paper describes an ego-motion estimation method by integrating multiple scan matching results. The method considers both the uncertainty of scan matching results and that of estimated ego-motions, and not only estimates the latest robot ego-motion but also updates previous ego-motions. The estimation process is formulated as an iterative one using Kalman filter. We implement the ego-motion estimation method using an omnidirectional stereo-based scan matching method which considers the uncertainty of the range data, and estimates the uncertainty of the result of the scan matching. Experimental results show the effectiveness of the proposed method.

[1]  Wolfram Burgard,et al.  An efficient fastSLAM algorithm for generating maps of large-scale cyclic environments from raw laser range measurements , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[2]  Peter Allen,et al.  Image-flow computation: An estimation-theoretic framework and a unified perspective , 1992, CVGIP Image Underst..

[3]  Minoru Etoh,et al.  Estimation of structure and motion parameters for a roaming robot that scans the space , 1999, Proceedings of the Seventh IEEE International Conference on Computer Vision.

[4]  Panos E. Trahanias,et al.  Closing multiple loops while mapping features in cyclic environments , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

[5]  Evangelos E. Milios,et al.  Robot Pose Estimation in Unknown Environments by Matching 2D Range Scans , 1997, J. Intell. Robotic Syst..

[6]  Stergios I. Roumeliotis,et al.  Weighted range sensor matching algorithms for mobile robot displacement estimation , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[7]  Yasushi Yagi,et al.  Environmental map generation and egomotion estimation in a dynamic environment for an omnidirectional image sensor , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[8]  Kevin Nickels,et al.  Estimating uncertainty in SSD-based feature tracking , 2002, Image Vis. Comput..

[9]  Hugh F. Durrant-Whyte,et al.  A computationally efficient solution to the simultaneous localisation and map building (SLAM) problem , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[10]  Yoshiaki Shirai,et al.  Real-time omnidirectional stereo for obstacle detection and tracking in dynamic environments , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).