3D map building for a humanoid robot by using visual odometry

Localization and 3D mapping are important tasks, for a humanoid robot to move in a complex human environment. In This work, we present a feature tracking based visual odometry system using stereo vision to achieve simultaneous 6D localization and 3D mapping. A camera position can be estimated from 3D environmental depth data and a previous 3D map, and used to incrementally update the 3D map. Visual odometry was employed to compute the view transformation relating a pair of views. Experimental results that estimate camera trajectory and build a 3D map are accurately obtained. The system is more accurate than typical dead-reckoning system such as gyro sensors.

[1]  Michael Garland,et al.  Surface simplification using quadric error metrics , 1997, SIGGRAPH.

[2]  João Alves,et al.  Registration and segmentation for 3D map building - a solution based on stereo vision and inertial sensors , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[3]  Masayuki Inaba,et al.  Plane segment finder: algorithm, implementation and applications , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[4]  Masayuki Inaba,et al.  Vision-based 2.5D terrain modeling for humanoid locomotion , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[5]  Carlo Tomasi,et al.  Good features to track , 1994, 1994 Proceedings of IEEE Conference on Computer Vision and Pattern Recognition.

[6]  Gérard G. Medioni,et al.  Object modelling by registration of multiple range images , 1992, Image Vis. Comput..

[7]  Paul J. Besl,et al.  A Method for Registration of 3-D Shapes , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[8]  Richard Szeliski,et al.  Visual odometry and map correlation , 2004, CVPR 2004.

[9]  Gang Wang,et al.  Registration and Integration of Multiple Object Views for 3D Model Construction , 1998, IEEE Trans. Pattern Anal. Mach. Intell..

[10]  Jorge Lobo,et al.  Registration and Segmentation for 3D Map Building , 2003 .

[11]  Clark F. Olson,et al.  Stereo ego-motion improvements for robust rover navigation , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

[12]  Gérard G. Medioni,et al.  Object modeling by registration of multiple range images , 1991, Proceedings. 1991 IEEE International Conference on Robotics and Automation.

[13]  Ioannis Stamos,et al.  Integration of range and image sensing for photo-realistic 3D modeling , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).