Pose Interpolation SLAM for large maps using moving 3D Sensors

Precise 3D mapping and 6DOF trajectory estimation using exteroceptive sensors are key problems in many fields. Real-time moving laser sensors gained popularity due to their precise depth measurements, high frame rate and large field of view.We propose an optimization framework for Simultaneous Localization And Mapping that properly models the acquisition process in a scanning-while-moving scenario. Each measurement is correctly reprojected in the map reference frame by considering a continuous time trajectory which is defined as the linear interpolation of a discrete set of control poses in SE3. We also employ an efficient data structure that makes use of a hybrid sparse voxelized representation, allowing large map management. Thanks to this we are also able to perform global optimization over trajectories, resetting the accumulated drift when loops are performed. We experimentally show that such framework improves localization and mapping w.r.t. solutions that compensate the distortion effects without including them in the optimization step. Moreover, we show that the proposed data structure provides linear or constant operations time w.r.t. the map size in order to perform real time SLAM and handles very large maps.

CERIANI Simone;  SANCHEZ BELENGUER Carlos;  TADDEI Pierluigi;  WOLFART Erik;  SEQUEIRA Vitor; 

2015-12-16

INSTITUTE OF ELECTRICAL AND ELECTRONICS ENGINEERS

JRC92351

http://ieeexplore.ieee.org/xpl/articleDetails.jsp?arnumber=7353456,    https://publications.jrc.ec.europa.eu/repository/handle/JRC92351,   

10.1109/IROS.2015.7353456,