Complex Terrain Mapping with Multi-camera Visual Odometry and Realtime Drift Correction

• Published in: 2012 Second International Conference on 3D Imaging, Modeling, Processing, Visualization & Transmission pp. 493 - 500
• Main Authors: Hadsell, R., Matei, B., Salgian, G., Das, A., Oskiper, T., Samarasekera, S.
• Format: Conference Proceeding
• Language: English
• Published: IEEE 01.10.2012
• Subjects: Cameras; Iterative closest point algorithm; Laser radar; Robot sensing systems; Tiles; Visualization
• ISBN: 1467344702; 9781467344708
• ISSN: 1550-6185
• DOI: 10.1109/3DIMPVT.2012.76

We present a low-cost navigation system that integrates 3D data in realtime, allowing exploration and mapping of complex terrain and GPS-denied regions with an inexpensive sensor package. Precise integration of 3D data from sensors on a moving platform requires accurate bearing and position estimates, delivered at high frequency. This bar has only been met using expensive, high-end IMUs and/or differential GPS systems - by contrast, our sensor package includes only a low-cost MEMS IMU. We use multi-camera visual odometry to obtain locally accurate position and orientation for integration of sequential scans from a 3D sensor. These intermediate point clouds accumulate in a custom database which features spatial caching and binary serialization for efficient querying and logarithmic retrieval times. Realtime alignment of overlapping 3D point clouds is used to correct drift. The system was tested using a mobile robot and used to map complex indoor and outdoor environments.