Compute-bound and low-bandwidth distributed 3D graph-SLAM

This article describes a new approach for distributed 3D SLAM map building. The key contribution of this article is the creation of a distributed graph-SLAM map-building architecture responsive to bandwidth and computational needs of the robotic platform. Responsiveness is afforded by integration of a 3D point cloud to plane cloud compression algorithm that approximates dense 3D point cloud using local planar patches. Compute bound platforms may restrict the computational duration of the compression algorithm and low-bandwidth platforms can restrict the size of the compression result. The backbone of the approach is an ultra-fast adaptive 3D compression algorithm that transforms swaths of 3D planar surface data into planar patches attributed with image textures. Our approach uses DVO, a leading algorithm for 3D mapping, and extends it by computationally isolating map integration tasks from local Guidance, Navigation and Control tasks and includes an addition of a network protocol to share the compressed planes. The joint effect of these contributions allows agents with 3D sensing capabilities to calculate and communicate compressed map information commensurate with their on-board computational resources and communication channel capacities. This opens SLAM mapping to new categories of robotic platforms that may have computational and memory limits that prohibit other SLAM solutions.

[1]  Stephanie Gil,et al.  Active Rendezvous for Multi-Robot Pose Graph Optimization using Sensing over Wi-Fi , 2019, ISRR.

[2]  Daniel Cremers,et al.  Dense visual SLAM for RGB-D cameras , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[3]  Renaud Dubé,et al.  An online multi-robot SLAM system for 3D LiDARs , 2017, 2017 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[4]  Matthias Nießner,et al.  BundleFusion , 2016, TOGS.

[5]  Wolfram Burgard,et al.  Probabilistic Robotics (Intelligent Robotics and Autonomous Agents) , 2005 .

[6]  Michael Gassner,et al.  SVO: Semidirect Visual Odometry for Monocular and Multicamera Systems , 2017, IEEE Transactions on Robotics.

[7]  S. Umeyama,et al.  Least-Squares Estimation of Transformation Parameters Between Two Point Patterns , 1991, IEEE Trans. Pattern Anal. Mach. Intell..

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

[9]  Guofeng Zhang,et al.  Keyframe-based dense planar SLAM , 2017, 2017 IEEE International Conference on Robotics and Automation (ICRA).

[10]  Chen Feng,et al.  Point-plane SLAM for hand-held 3D sensors , 2013, 2013 IEEE International Conference on Robotics and Automation.

[11]  Carlos Sagüés,et al.  Distributed Data Association in Robotic Networks With Cameras and Limited Communications , 2013, IEEE Transactions on Robotics.

[12]  Nathan Michael,et al.  Distributed real-time cooperative localization and mapping using an uncertainty-aware expectation maximization approach , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Hugh F. Durrant-Whyte,et al.  Decentralised SLAM with Low-Bandwidth Communication for Teams of Vehicles , 2003, FSR.

[14]  Frank Dellaert,et al.  DDF-SAM 2.0: Consistent distributed smoothing and mapping , 2013, 2013 IEEE International Conference on Robotics and Automation.

[15]  Frank Dellaert,et al.  Distributed mapping with privacy and communication constraints: Lightweight algorithms and object-based models , 2017, Int. J. Robotics Res..

[16]  Henrik I. Christensen,et al.  Planar surface SLAM with 3D and 2D sensors , 2012, 2012 IEEE International Conference on Robotics and Automation.

[17]  Titus Cieslewski,et al.  Efficient decentralized visual place recognition from full-image descriptors , 2017, 2017 International Symposium on Multi-Robot and Multi-Agent Systems (MRS).

[18]  Peter Cheeseman,et al.  On the Representation and Estimation of Spatial Uncertainty , 1986 .

[19]  A. Aydin Alatan,et al.  Rate-Distortion Based Piecewise Planar 3D Scene Geometry Representation , 2007, 2007 IEEE International Conference on Image Processing.

[20]  Daniel Cremers,et al.  Real-time visual odometry from dense RGB-D images , 2011, 2011 IEEE International Conference on Computer Vision Workshops (ICCV Workshops).

[21]  Daniel Cremers,et al.  Direct Sparse Odometry , 2016, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[22]  Titus Cieslewski,et al.  Data-Efficient Decentralized Visual SLAM , 2017, 2018 IEEE International Conference on Robotics and Automation (ICRA).

[23]  Jonathan P. How,et al.  Near-Optimal Budgeted Data Exchange for Distributed Loop Closure Detection , 2018, Robotics: Science and Systems.

[24]  Daniel Cremers,et al.  LSD-SLAM: Large-Scale Direct Monocular SLAM , 2014, ECCV.

[25]  Patrick Rives,et al.  Accurate Quadrifocal Tracking for Robust 3D Visual Odometry , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[26]  Maria Teresa Lazaro,et al.  Multi-robot SLAM using condensed measurements , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[27]  Luke Fletcher,et al.  Multiple relative pose graphs for robust cooperative mapping , 2010, 2010 IEEE International Conference on Robotics and Automation.

[28]  Paul H. J. Kelly,et al.  SLAM++: Simultaneous Localisation and Mapping at the Level of Objects , 2013, 2013 IEEE Conference on Computer Vision and Pattern Recognition.

[29]  A. Willis,et al.  Real-time surface fitting to RGBD sensor data , 2017, SoutheastCon.

[30]  Stefan Leutenegger,et al.  ElasticFusion: Real-time dense SLAM and light source estimation , 2016, Int. J. Robotics Res..

[31]  Hugh F. Durrant-Whyte,et al.  Decentralised cooperative localisation for heterogeneous teams of mobile robots , 2011, 2011 IEEE International Conference on Robotics and Automation.

[32]  Jon Louis Bentley,et al.  Quad trees a data structure for retrieval on composite keys , 1974, Acta Informatica.

[33]  Brendan J. Frey,et al.  Factor graphs and the sum-product algorithm , 2001, IEEE Trans. Inf. Theory.

[34]  Paul H. J. Kelly,et al.  Dense planar SLAM , 2014, 2014 IEEE International Symposium on Mixed and Augmented Reality (ISMAR).

[35]  Andrew W. Fitzgibbon,et al.  KinectFusion: Real-time dense surface mapping and tracking , 2011, 2011 10th IEEE International Symposium on Mixed and Augmented Reality.

[36]  Jonathan P. How,et al.  A resource-aware approach to collaborative loop-closure detection with provable performance guarantees , 2019, Int. J. Robotics Res..

[37]  Luca Carlone,et al.  DOOR-SLAM: Distributed, Online, and Outlier Resilient SLAM for Robotic Teams , 2020, IEEE Robotics and Automation Letters.

[38]  Eduardo Montijano,et al.  Visual data association in narrow-bandwidth networks , 2015, 2015 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[39]  Roland Siegwart,et al.  Orthogonal SLAM: a Step toward Lightweight Indoor Autonomous Navigation , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[40]  Titus Cieslewski,et al.  Efficient Decentralized Visual Place Recognition Using a Distributed Inverted Index , 2017, IEEE Robotics and Automation Letters.

[41]  Michael Kaess,et al.  Simultaneous localization and mapping with infinite planes , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[42]  Joaquim Salvi,et al.  The SLAM problem: a survey , 2008, CCIA.

[43]  Andrew J. Davison,et al.  DTAM: Dense tracking and mapping in real-time , 2011, 2011 International Conference on Computer Vision.

[44]  Wolfram Burgard,et al.  A Tutorial on Graph-Based SLAM , 2010, IEEE Intelligent Transportation Systems Magazine.

[45]  F. Dellaert Factor Graphs and GTSAM: A Hands-on Introduction , 2012 .