Active Rendezvous for Multi-Robot Pose Graph Optimization using Sensing over Wi-Fi

We present a novel framework for collaboration amongst a team of robots performing Pose Graph Optimization (PGO) that addresses two important challenges for multi-robot SLAM: that of enabling information exchange "on-demand" via active rendezvous, and that of rejecting outlier measurements with high probability. Our key insight is to exploit relative position data present in the communication channel between agents, as an independent measurement in PGO. We show that our algorithmic and experimental framework for integrating Channel State Information (CSI) over the communication channels, with multi-agent PGO, addresses the two open challenges of enabling information exchange and rejecting outliers. Our presented framework is distributed and applicable in low-lighting or featureless environments where traditional sensors often fail. We present extensive experimental results on actual robots showing both the use of active rendezvous resulting in error reduction by 6X as compared to randomly occurring rendezvous and the use of CSI observations providing a reduction in ground truth pose estimation errors of 32%. These results demonstrate the promise of using a combination of multi-robot coordination and CSI to address challenges in multi-agent localization and mapping -- providing an important step towards integrating communication as a novel sensor for SLAM tasks.

[1]  Swarun Kumar,et al.  Guaranteeing spoof-resilient multi-robot networks , 2015, Autonomous Robots.

[2]  John J. Leonard,et al.  Communication-constrained multi-AUV cooperative SLAM , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[3]  Kurt Konolige,et al.  Distributed Multirobot Exploration and Mapping , 2005, Proceedings of the IEEE.

[4]  Michael Trentini,et al.  Multiple‐Robot Simultaneous Localization and Mapping: A Review , 2016, J. Field Robotics.

[5]  Jaime Valls Miró,et al.  Active Pose SLAM , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[7]  Francesco Bullo,et al.  On frame and orientation localization for relative sensing networks , 2013, Autom..

[8]  Juan Andrade-Cetto,et al.  Active pose SLAM with RRT* , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

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

[10]  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.

[11]  Matt Welsh,et al.  MoteTrack: A Robust, Decentralized Approach to RF-Based Location Tracking , 2005, LoCA.

[12]  Jue Wang,et al.  Dude, where's my card?: RFID positioning that works with multipath and non-line of sight , 2013, SIGCOMM.

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

[14]  Ruggero Carli,et al.  Distributed localization from relative noisy measurements: A robust gradient based approach , 2015, 2015 European Control Conference (ECC).

[15]  Basilio Bona,et al.  Active SLAM and Exploration with Particle Filters Using Kullback-Leibler Divergence , 2014, J. Intell. Robotic Syst..

[16]  Swarun Kumar,et al.  Adaptive communication in multi-robot systems using directionality of signal strength , 2015, Int. J. Robotics Res..

[17]  Giuseppe C. Calafiore,et al.  Noisy Range Network Localization Based on Distributed Multidimensional Scaling , 2015, IEEE Sensors Journal.

[18]  Soummya Kar,et al.  Linear Theory for Self-Localization: Convexity, Barycentric Coordinates, and Cayley–Menger Determinants , 2015, IEEE Access.

[19]  Cyrill Stachniss,et al.  Information-theoretic compression of pose graphs for laser-based SLAM , 2012, Int. J. Robotics Res..

[20]  John J. Leonard,et al.  Past, Present, and Future of Simultaneous Localization and Mapping: Toward the Robust-Perception Age , 2016, IEEE Transactions on Robotics.

[21]  David Wetherall,et al.  Tool release: gathering 802.11n traces with channel state information , 2011, CCRV.

[22]  Giuseppe C. Calafiore,et al.  Convex Relaxations for Pose Graph Optimization With Outliers , 2018, IEEE Robotics and Automation Letters.

[23]  Swarun Kumar,et al.  Accurate indoor localization with zero start-up cost , 2014, MobiCom.

[24]  Wolfram Burgard,et al.  Coordination for Multi-Robot Exploration and Mapping , 2000, AAAI/IAAI.

[25]  Wolfram Burgard,et al.  A benchmark for the evaluation of RGB-D SLAM systems , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  Davide Scaramuzza,et al.  A Tutorial on Quantitative Trajectory Evaluation for Visual(-Inertial) Odometry , 2018, 2018 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[27]  Swarun Kumar,et al.  LTE radio analytics made easy and accessible , 2015, SIGCOMM 2015.

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

[29]  Gregory Dudek,et al.  Collaborative Robot Exploration and Rendezvous: Algorithms, Performance Bounds and Observations , 2001, Auton. Robots.