Renaud Dubé1, Mattia Guglielmo Gollub2, Hannes Sommer1, Igor Gilitschenski3, Roland Siegwart2, Cesar D. Cadena Lerma2, Juan Nieto2
10:30 - 13:00 | Tue 22 May | podR | [email protected]
Localization in 3D point clouds is a highly challenging task due to the complexity associated with extracting information from 3D data. This paper proposes an incremental approach addressing this problem efficiently. The presented method first accumulates the measurements in a dynamic voxel grid and selectively updates the point normals affected by the insertion. An incremental segmentation algorithm, based on region growing, tracks the evolution of single segments which enables an efficient recognition strategy using partitioning and caching of geometric consistencies. We show that the incremental method can perform global localization at 10Hz in a urban driving environment, a speedup of x7.1 over the compared batch solution. The efficiency of the method makes it suitable for applications where real-time localization is required and enables its usage on cheaper, low-energy systems. Our implementation is available open source along with instructions for running the system.