Real-Time Robot Trajectory Estimation and 3D Map Construction using 3D Camera

Our research objective is simultaneous localization and mapping (SLAM) in rubble environment. The map construction requires estimation of robot trajectory in 3D space. However, it is hard to estimate it by using odometry or gyro in rubble. In this paper, the authors proposed real-time SLAM based on 3D scan match. 3D camera is used for measurement of 3D shape and its texture in real-time. 3D map and robot trajectory are estimated by combining these 3D scan data. ICP algorithm is used for the matching method. The authors modified ICP algorithm as fast and robust one for real-time 3D map construction

[1]  Richard A. Volz,et al.  Estimating 3-D location parameters using dual number quaternions , 1991, CVGIP Image Underst..

[2]  Sebastian Thrun,et al.  Online simultaneous localization and mapping with detection and tracking of moving objects: theory and results from a ground vehicle in crowded urban areas , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[3]  Sebastian Thrun,et al.  Scan Alignment and 3-D Surface Modeling with a Helicopter Platform , 2003, FSR.

[4]  Kazunori Ohno,et al.  Dense 3D map building based on LRF data and color image fusion , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[5]  Zhengyou Zhang,et al.  Iterative point matching for registration of free-form curves and surfaces , 1994, International Journal of Computer Vision.

[6]  Eduardo Mario Nebot,et al.  Improving computational and memory requirements of simultaneous localization and map building algorithms , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[7]  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).

[8]  Roland Siegwart,et al.  A state-of-the-art 3D sensor for robot navigation , 2004 .

[9]  Takashi Tsubouchi,et al.  Outdoor map building based on odometry and RTK-GPS positioning fusion , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[10]  Wolfram Burgard,et al.  Map building with mobile robots in dynamic environments , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[11]  Keiji Nagatani,et al.  Three-dimensional localization and mapping for a crawler-type mobile robot in an occluded area using the scan matching method , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[12]  Sebastian Thrun,et al.  6D SLAM with an application in autonomous mine mapping , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.