Decentralized Cooperative SLAM for Sparsely-Communicating Robot Networks: A Centralized-Equivalent Approach

Communication between robots is key to performance in cooperative multi-robot systems. In practice, communication connections for information exchange between all robots are not always guaranteed, which adds difficulty in performing state estimation. This paper examines the decentralized cooperative simultaneous localization and mapping (SLAM) problem, in which each robot is required to estimate the map and all robot states under a sparsely-communicating and dynamic network. We show how the exact, centralized-equivalent estimate can be obtained by all robots in the network in a decentralized manner even when the network is never fully connected. Furthermore, a robot only needs to consider its own knowledge of the network topology in order to detect when the centralized-equivalent estimate is obtainable. Our approach is validated through more than 250 min of hardware experiments using a team of real robots. The resulting estimates are compared against accurate groundtruth data for all robot poses and landmark positions. In addition, we examined the effects of communication range limit on our algorithm’s performance.

[1]  Stergios I. Roumeliotis,et al.  Propagation of Uncertainty in Cooperative Multirobot Localization: Analysis and Experimental Results , 2004, Auton. Robots.

[2]  Kurt Konolige,et al.  A practical, decision-theoretic approach to multi-robot mapping and exploration , 2003, Proceedings 2003 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS 2003) (Cat. No.03CH37453).

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

[4]  Stephen B. Wicker,et al.  Phase transition phenomena in wireless ad hoc networks , 2001, GLOBECOM'01. IEEE Global Telecommunications Conference (Cat. No.01CH37270).

[5]  Y. Bar-Shalom,et al.  One-step solution for the multistep out-of-sequence-measurement problem in tracking , 2004, IEEE Transactions on Aerospace and Electronic Systems.

[6]  Richard T. Vaughan,et al.  The Player/Stage Project: Tools for Multi-Robot and Distributed Sensor Systems , 2003 .

[7]  Keith Yu Kit Leung,et al.  Decentralized Localization of Sparsely-Communicating Robot Networks: A Centralized-Equivalent Approach , 2010, IEEE Transactions on Robotics.

[8]  Sebastian Thrun,et al.  Decentralized Sensor Fusion with Distributed Particle Filters , 2002, UAI.

[9]  Cyrill Stachniss,et al.  Exploration and mapping with mobile robots , 2006 .

[10]  Keith Yu Kit Leung,et al.  Distributed and decentralized cooperative simultaneous localization and mapping for dynamic and sparse robot networks , 2010, 2011 IEEE International Conference on Robotics and Automation.

[11]  Yaakov Bar-Shalom.  Update with out-of-sequence measurements in tracking: exact solution , 2002 .

[12]  Hugh F. Durrant-Whyte,et al.  Multiple-platform localization and map building , 2000, SPIE Optics East.

[13]  Aníbal Ollero,et al.  Delayed-state information filter for cooperative decentralized tracking , 2009, 2009 IEEE International Conference on Robotics and Automation.

[14]  Stergios I. Roumeliotis,et al.  Distributed multirobot localization , 2002, IEEE Trans. Robotics Autom..

[15]  M.R. Shikh-Bahaei,et al.  Interference cancellation in W-CDMA cellular structures using statistical processing , 1999, Seamless Interconnection for Universal Services. Global Telecommunications Conference. GLOBECOM'99. (Cat. No.99CH37042).

[16]  Shoudong Huang,et al.  Multi-robot simultaneous localization and mapping using D-SLAM framework , 2007, 2007 3rd International Conference on Intelligent Sensors, Sensor Networks and Information.

[17]  S. Reece,et al.  Robust, low-bandwidth, multi-vehicle mapping , 2005, 2005 7th International Conference on Information Fusion.

[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]  Ryo Kurazume,et al.  An Experimental Study of a Cooperative Positioning System , 2000, Auton. Robots.

[21]  Keith Yu Kit Leung,et al.  The UTIAS multi-robot cooperative localization and mapping dataset , 2011, Int. J. Robotics Res..

[22]  Stergios I. Roumeliotis,et al.  Asynchronous Multi-Centralized Cooperative Localization , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[23]  Gaurav S. Sukhatme,et al.  Putting the 'I' in 'team': an ego-centric approach to cooperative localization , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[24]  Hugh F. Durrant-Whyte,et al.  Simultaneous Localization and Mapping with Sparse Extended Information Filters , 2004, Int. J. Robotics Res..

[25]  Gaurav S. Sukhatme,et al.  Multirobot Simultaneous Localization and Mapping Using Manifold Representations , 2006, Proceedings of the IEEE.

[26]  Markus Windolf,et al.  Systematic accuracy and precision analysis of video motion capturing systems--exemplified on the Vicon-460 system. , 2008, Journal of biomechanics.

[27]  Dan Simon,et al.  Optimal State Estimation: Kalman, H∞, and Nonlinear Approaches , 2006 .

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