Local Multi-resolution Surfel Grids for MAV Motion Estimation and 3D Mapping

For autonomous navigation in restricted environments, micro aerial vehicles (MAV) need to create 3D maps of their surroundings and must track their motion within these maps. In this paper, we propose an approach to simultaneous localization and mapping that is based on the measurements of a lightweight 3D laser-range finder. We aggregate laser-range measurements by registering sparse 3D scans with a local multiresolution surfel map that has high resolution in the vicinity of the MAV and coarser resolutions with increasing distance, which corresponds well to measurement density and accuracy of our sensor. Modeling measurement distributions within voxels by surface elements allows for efficient and accurate registration of 3D scans with the local map. The incrementally built local dense 3D maps of nearby key poses are registered globally by graph optimization. This yields a globally consistent dense 3D map of the environment. Continuous registration of local maps with the global map allows for tracking the 6D MAV pose in real time. In experiments, we demonstrate accuracy and efficiency of our approach.

[1]  Christopher M. Bishop,et al.  Pattern Recognition and Machine Learning (Information Science and Statistics) , 2006 .

[2]  Huosheng Hu,et al.  3D mapping with multi-resolution occupied voxel lists , 2010, Auton. Robots.

[3]  Wolfram Burgard,et al.  A Fully Autonomous Indoor Quadrotor , 2012, IEEE Transactions on Robotics.

[4]  Jörg Stückler,et al.  Multi-resolution surfel mapping and real-time pose tracking using a continuously rotating 2D laser scanner , 2013, 2013 IEEE International Symposium on Safety, Security, and Rescue Robotics (SSRR).

[5]  Greg,et al.  Flight Control Law Design and Development For An Autonomous Rotorcraft , 2008 .

[6]  Vijay Kumar,et al.  Autonomous multi-floor indoor navigation with a computationally constrained micro aerial vehicle , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[8]  A. Nuchter,et al.  6D SLAM with approximate data association , 2005, ICAR '05. Proceedings., 12th International Conference on Advanced Robotics, 2005..

[9]  Wolfram Burgard,et al.  OctoMap: an efficient probabilistic 3D mapping framework based on octrees , 2013, Autonomous Robots.

[10]  Abraham Bachrach,et al.  Autonomous flight in unstructured and unknown indoor environments , 2009 .

[11]  Paul Newman,et al.  Lost in translation (and rotation): Rapid extrinsic calibration for 2D and 3D LIDARs , 2012, 2012 IEEE International Conference on Robotics and Automation.

[12]  Wolfgang Förstner,et al.  INCREMENTAL REAL-TIME BUNDLE ADJUSTMENT FOR MULTI-CAMERA SYSTEMS WITH POINTS AT INFINITY , 2013 .

[13]  Libor Preucil,et al.  European Robotics Symposium 2008 , 2008 .

[14]  Tom Duckett,et al.  Scan registration for autonomous mining vehicles using 3D‐NDT , 2007, J. Field Robotics.

[15]  Jörg Stückler,et al.  Local multi-resolution representation for 6D motion estimation and mapping with a continuously rotating 3D laser scanner , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[16]  Nicholas Roy,et al.  Autonomous Flight in Unknown Indoor Environments , 2009 .

[17]  Sven Behnke,et al.  Multimodal obstacle detection and collision avoidance for micro aerial vehicles , 2013, 2013 European Conference on Mobile Robots.

[18]  Sebastian Scherer,et al.  Sparse Tangential Network (SPARTAN): Motion planning for micro aerial vehicles , 2013, 2013 IEEE International Conference on Robotics and Automation.

[19]  Wolfram Burgard,et al.  G2o: A general framework for graph optimization , 2011, 2011 IEEE International Conference on Robotics and Automation.

[20]  Achim J. Lilienthal,et al.  Maximum likelihood point cloud acquisition from a mobile platform , 2009, 2009 International Conference on Advanced Robotics.

[21]  Jonghyuk Kim,et al.  Integrated navigation system using camera and gimbaled laser scanner for indoor and outdoor autonomous flight of UAVs , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Andreas Nüchter,et al.  6DOF semi-rigid SLAM for mobile scanning , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Jörg Stückler,et al.  Multi-resolution surfel maps for efficient dense 3D modeling and tracking , 2014, J. Vis. Commun. Image Represent..

[24]  Darius Burschka,et al.  Toward a Fully Autonomous UAV: Research Platform for Indoor and Outdoor Urban Search and Rescue , 2012, IEEE Robotics & Automation Magazine.

[25]  Wolfram Burgard,et al.  Towards a navigation system for autonomous indoor flying , 2009, 2009 IEEE International Conference on Robotics and Automation.

[26]  J A Barbera,et al.  Urban search and rescue. , 1996, Emergency medicine clinics of North America.

[27]  Wolfgang Förstner,et al.  Bundle Adjustment for Multi-Camera Systems with Points at Infinity , 2012 .

[28]  Andriy Myronenko,et al.  Point Set Registration: Coherent Point Drift , 2009, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[29]  Michael Bosse,et al.  Continuous 3D scan-matching with a spinning 2D laser , 2009, 2009 IEEE International Conference on Robotics and Automation.

[30]  Sebastian Scherer,et al.  River mapping from a flying robot: state estimation, river detection, and obstacle mapping , 2012, Auton. Robots.

[31]  Tim D. Barfoot,et al.  Towards relative continuous-time SLAM , 2013, 2013 IEEE International Conference on Robotics and Automation.