Cooperative localization by factor composition over a faulty low-bandwidth communication channel

This paper reports on an underwater cooperative localization algorithm for faulty low-bandwidth communication channels based on a factor graph estimation framework. Vehicles measure the one-way-travel-time (OWTT) of acoustic broadcasts to obtain a relative range observation to the transmitting vehicle. We present a method to robustly share locally observed sensor data across the network by exploiting odometry factor composition. Our algorithm calls on approximate marginalization techniques to compute a compact set of informative factors that enable local navigation data to be shared efficiently. We provide results from a real-time implementation of our algorithm using two autonomous underwater vehicles and a surface vehicle.

[1]  Peter C. Cheeseman,et al.  Estimating uncertain spatial relationships in robotics , 1986, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[2]  Ryo Kurazume,et al.  Cooperative positioning with multiple robots , 1994, Proceedings of the 1994 IEEE International Conference on Robotics and Automation.

[3]  Wolfram Burgard,et al.  A Probabilistic Approach to Collaborative Multi-Robot Localization , 2000, Auton. Robots.

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

[5]  Gaurav S. Sukhatme,et al.  Localization for mobile robot teams using maximum likelihood estimation , 2002, IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Frank Dellaert,et al.  Intrinsic Localization and Mapping with 2 applications: Diffusion Mapping and Macro Polo localization , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[7]  J.J. Leonard,et al.  Experimental validation of the moving long base-line navigation concept , 2004, 2004 IEEE/OES Autonomous Underwater Vehicles (IEEE Cat. No.04CH37578).

[8]  Frank Dellaert,et al.  Square Root SAM , 2005, Robotics: Science and Systems.

[9]  John J. Leonard,et al.  Cooperative Localization for Autonomous Underwater Vehicles , 2009, Int. J. Robotics Res..

[10]  Frank Dellaert,et al.  Square Root SAM: Simultaneous Localization and Mapping via Square Root Information Smoothing , 2006, Int. J. Robotics Res..

[11]  D.J. Stilwell,et al.  Implementation of a Cooperative Navigation Algorithm on a Platoon of Autonomous Underwater Vehicles , 2007, OCEANS 2007.

[12]  Matthew R. Walter,et al.  Consistent cooperative localization , 2009, 2009 IEEE International Conference on Robotics and Automation.

[13]  John J. Leonard,et al.  Cooperative Localization for Autonomous Underwater Vehicles , 2009, Int. J. Robotics Res..

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

[15]  John J. Leonard,et al.  A measurement distribution framework for cooperative navigation using multiple AUVs , 2010, 2010 IEEE International Conference on Robotics and Automation.

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

[17]  Hugh F. Durrant-Whyte,et al.  Conservative Sparsification for efficient and consistent approximate estimation , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[18]  Hanumant Singh,et al.  Synchronous‐clock, one‐way‐travel‐time acoustic navigation for underwater vehicles , 2011, J. Field Robotics.

[19]  Hanumant Singh,et al.  Advances in single-beacon one-way-travel-time acoustic navigation for underwater vehicles , 2012, Int. J. Robotics Res..

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

[21]  Stergios I. Roumeliotis,et al.  A communication-bandwidth-aware hybrid estimation framework for multi-robot cooperative localization , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Ryan M. Eustice,et al.  Decentralized Extended Information Filter for Single-Beacon Cooperative Acoustic Navigation: Theory and Experiments , 2013, IEEE Transactions on Robotics.

[23]  John J. Leonard,et al.  Consistent sparsification for graph optimization , 2013, 2013 European Conference on Mobile Robots.

[24]  Michael Kaess,et al.  Generic Node Removal for Factor-Graph SLAM , 2014, IEEE Transactions on Robotics.

[25]  Ryan M. Eustice,et al.  Learning visual feature descriptors for dynamic lighting conditions , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[26]  Wolfram Burgard,et al.  Nonlinear Graph Sparsification for SLAM , 2014, Robotics: Science and Systems.

[27]  John J. Leonard,et al.  Decentralized cooperative trajectory estimation for autonomous underwater vehicles , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[28]  Ryan M. Eustice,et al.  An origin state method for communication constrained cooperative localization with robustness to packet loss , 2014, Int. J. Robotics Res..