A framework for multi-robot pose graph SLAM

We introduce a software framework for real-time multi-robot collaborative SLAM. Rather than building a complete SLAM system, our framework is designed to enable collaborative mapping for existing (single-robot) SLAM systems in a convenient fashion. The framework aggregates local pose graphs obtained from its multiple robots into a global pose graph, which it then feeds back to the robots to increase their mapping and localization effectiveness. The framework can potentially work with various SLAM algorithms, as long as they provide a pose graph with an image associated with each node, and absolute scaling. The merging of pose graphs is purely visual-based and does not require well-defined initial robot positions nor environment markers. To handle network delays, we propose a graph correction scheme that avoids using mutexes (and thus avoids modifying the existing SLAM system) by assuming local graph consistency. Furthermore, we propose a simple image feature filtering method that uses an associated depth image to filter image features unsuitable for scene recognition. We demonstrate the framework's functionality with several interior datasets that we have collected using three robots.

[1]  Edwin Olson,et al.  Recognizing places using spectrally clustered local matches , 2009, Robotics Auton. Syst..

[2]  Gordon Wyeth,et al.  OpenFABMAP: An open source toolbox for appearance-based loop closure detection , 2012, 2012 IEEE International Conference on Robotics and Automation.

[3]  Gary R. Bradski,et al.  ORB: An efficient alternative to SIFT or SURF , 2011, 2011 International Conference on Computer Vision.

[4]  Paul Newman,et al.  Appearance-only SLAM at large scale with FAB-MAP 2.0 , 2011, Int. J. Robotics Res..

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

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

[7]  John J. Leonard,et al.  Temporally scalable visual SLAM using a reduced pose graph , 2013, 2013 IEEE International Conference on Robotics and Automation.

[8]  Max Pfingsthorn,et al.  UvA-DARE ( Digital Academic Repository ) A scalable hybrid multi-robot SLAM method for highly detailed maps , 2007 .

[9]  J. M. M. Montiel,et al.  ORB-SLAM: A Versatile and Accurate Monocular SLAM System , 2015, IEEE Transactions on Robotics.

[10]  Frank Dellaert,et al.  iSAM2: Incremental smoothing and mapping with fluid relinearization and incremental variable reordering , 2011, 2011 IEEE International Conference on Robotics and Automation.

[11]  Davide Scaramuzza,et al.  SVO: Fast semi-direct monocular visual odometry , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[12]  Laurent Kneip,et al.  OpenGV: A unified and generalized approach to real-time calibrated geometric vision , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[13]  Nathan Michael,et al.  Multi-robot pose graph localization and data association from unknown initial relative poses via expectation maximization , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[14]  Mohamed I. Roushdy,et al.  Comparison of Optimization Techniques for 3 D Graph-based SLAM , 2013 .

[15]  Wolfram Burgard,et al.  Fully distributed scalable smoothing and mapping with robust multi-robot data association , 2012, 2012 IEEE International Conference on Robotics and Automation.

[16]  Michael Milford,et al.  Towards condition-invariant, top-down visual place recognition , 2013, ICRA 2013.

[17]  Fabio Tozeto Ramos,et al.  Robust place recognition with stereo cameras , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[18]  Andrew Howard,et al.  Multi-robot Simultaneous Localization and Mapping using Particle Filters , 2005, Int. J. Robotics Res..

[19]  Stergios I. Roumeliotis,et al.  Multi-robot SLAM with Unknown Initial Correspondence: The Robot Rendezvous Case , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Laurent Kneip,et al.  Collaborative monocular SLAM with multiple Micro Aerial Vehicles , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Javier Civera,et al.  C2TAM: A Cloud framework for cooperative tracking and mapping , 2014, Robotics Auton. Syst..

[22]  John J. Leonard,et al.  Cooperative concurrent mapping and localization , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[23]  David Nistér,et al.  An efficient solution to the five-point relative pose problem , 2004, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[24]  Niko Sünderhauf,et al.  Switchable constraints for robust pose graph SLAM , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[25]  Andrew Howard,et al.  Multi-robot mapping using manifold representations , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

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

[27]  H. C. Longuet-Higgins,et al.  A computer algorithm for reconstructing a scene from two projections , 1981, Nature.

[28]  Roland Siegwart,et al.  Regional topological segmentation based on mutual information graphs , 2011, 2011 IEEE International Conference on Robotics and Automation.

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

[30]  Wolfram Burgard,et al.  Robust place recognition for 3D range data based on point features , 2010, 2010 IEEE International Conference on Robotics and Automation.

[31]  Stefan B. Williams,et al.  Multi-vehicle localisation with additive compressed factor graphs , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[32]  David Nistér,et al.  An efficient solution to the five-point relative pose problem , 2003, 2003 IEEE Computer Society Conference on Computer Vision and Pattern Recognition, 2003. Proceedings..

[33]  Morgan Quigley,et al.  ROS: an open-source Robot Operating System , 2009, ICRA 2009.

[34]  Juan D. Tardós,et al.  Probabilistic Semi-Dense Mapping from Highly Accurate Feature-Based Monocular SLAM , 2015, Robotics: Science and Systems.