Decentralized Extended Information Filter for Single-Beacon Cooperative Acoustic Navigation: Theory and Experiments

We report a decentralized extended information filter (DEIF) algorithm designed for single-beacon cooperative acoustic navigation of one or more client underwater vehicles. In single-beacon cooperative acoustic navigation, ranges and state information from a single reference source (the server) are used to improve localization and navigation of an underwater vehicle (the client). The ranges and state information are obtained using underwater acoustic modems and a synchronous-clock time-of-flight paradigm. Apart from the server's acoustic data broadcasts, the client has no access to the server's position or sensor measurements. We show that at the instance of each range measurement update, the DEIF algorithm yields identical results for the current vehicle state estimate as the corresponding centralized extended information filter (CEIF), which fully tracks the joint probability distribution between the server and client. We compare the state estimation results of the DEIF algorithm with that of a CEIF and three other filters reported in the literature. The evaluation is performed using both simulated data and an experimental dataset comprised of one surface craft and two autonomous underwater vehicles.

[1]  R. Eustice,et al.  Development of a multi-AUV SLAM testbed at the University of Michigan , 2008, OCEANS 2008.

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

[3]  Hugh F. Durrant-Whyte,et al.  Decentralised Solutions to the Cooperative Multi-Platform Navigation Problem , 2011, IEEE Transactions on Aerospace and Electronic Systems.

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

[5]  Arthur G. O. Mutambara,et al.  Decentralized Estimation and Control for Multisensor Systems , 2019 .

[6]  Hanumant Singh,et al.  Experimental Results in Synchronous-Clock One-Way-Travel-Time Acoustic Navigation for Autonomous Underwater Vehicles , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[7]  D. A. Smallwood,et al.  Model-based dynamic positioning of underwater robotic vehicles: theory and experiment , 2004, IEEE Journal of Oceanic Engineering.

[8]  Bruno Jouvencel,et al.  Homing and navigation using one transponder for AUV, postprocessing comparisons results with long base-line navigation , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

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

[10]  Frank Dellaert,et al.  iSAM: Incremental Smoothing and Mapping , 2008, IEEE Transactions on Robotics.

[11]  Ryan M. Eustice,et al.  Preliminary Results in Decentralized Estimation for Single-Beacon Acoustic Underwater Navigation , 2010, Robotics: Science and Systems.

[12]  L. Whitcomb,et al.  A SURVEY OF UNDERWATER VEHICLE NAVIGATION : RECENT ADVANCES AND NEW CHALLENGES , 2006 .

[13]  Hanumant Singh,et al.  Advances in Underwater Robot Vehicles for Deep Ocean Exploration: Navigation, Control, and Survey Operations , 2000 .

[14]  Ryan M. Eustice,et al.  Toward a platform-independent acoustic communications and navigation system for underwater vehicles , 2009, OCEANS 2009.

[15]  Carlos Sagüés,et al.  Distributed Consensus on Robot Networks for Dynamically Merging Feature-Based Maps , 2012, IEEE Transactions on Robotics.

[16]  Robert C. Spindel,et al.  An acoustic navigation system , 1974 .

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

[18]  Ryan M. Eustice,et al.  Experimental comparison of synchronous-clock cooperative acoustic navigation algorithms , 2011, OCEANS'11 MTS/IEEE KONA.

[19]  Esha D. Nerurkar,et al.  Hybrid Estimation Framework for Multi-robot Cooperative Localization using Quantized Measurements , 2011 .

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

[21]  Brian Neil Levine,et al.  A survey of practical issues in underwater networks , 2006, MOCO.

[22]  Ryan M. Eustice,et al.  An Origin State Method for Lossy Synchronous-clock Acoustic Navigation , 2012 .

[23]  Stergios I. Roumeliotis,et al.  Robot-to-Robot Relative Pose Estimation From Range Measurements , 2008, IEEE Transactions on Robotics.

[24]  Stergios I. Roumeliotis,et al.  SOI-KF: Distributed Kalman Filtering With Low-Cost Communications Using The Sign Of Innovations , 2006, 2006 IEEE International Conference on Acoustics Speech and Signal Processing Proceedings.

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

[26]  S. Singh,et al.  The WHOI micro-modem: an acoustic communications and navigation system for multiple platforms , 2005, Proceedings of OCEANS 2005 MTS/IEEE.

[27]  Daniel J. Stilwell,et al.  Underwater navigation in the presence of unknown currents based on range measurements from a single location , 2005, Proceedings of the 2005, American Control Conference, 2005..

[28]  Lee Freitag,et al.  Acoustic communication performance of the WHOI Micro-Modem in sea trials of the Nereus vehicle to 11,000 m depth , 2009, OCEANS 2009.

[29]  I.T. Ruiz,et al.  Decentralised Simultaneous Localisation and Mapping for AUVs , 2007, OCEANS 2007 - Europe.

[30]  A.B. Baggeroer,et al.  The state of the art in underwater acoustic telemetry , 2000, IEEE Journal of Oceanic Engineering.

[31]  T. Song.  Observability of target tracking with range-only measurements , 1999 .

[32]  Ehud Rivlin,et al.  Graph-based distributed cooperative navigation , 2011, 2011 IEEE International Conference on Robotics and Automation.

[33]  L.L. Whitcomb,et al.  Recent Advances in Synchronous-Clock One-Way-Travel-Time Acoustic Navigation , 2006, OCEANS 2006.

[34]  Sandor M. Veres,et al.  Geometric bounding techniques for underwater localization using range-only sensors , 2011 .

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

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

[37]  Tim Bailey,et al.  Decentralised Data Fusion with Delayed States for Consistent Inference in Mobile Ad Hoc Networks , 2007 .

[38]  M. Pebody,et al.  Range-Only Positioning of a Deep-Diving Autonomous Underwater Vehicle From a Surface Ship , 2009, IEEE Journal of Oceanic Engineering.

[39]  S. Grime,et al.  Communication in Decentralized Data-Fusion Systems , 1992, 1992 American Control Conference.

[40]  P. H. Milne,et al.  Underwater Acoustic Positioning Systems , 1983 .

[41]  John J. Leonard,et al.  Cooperative AUV Navigation Using a Single Surface Craft , 2009, FSR.

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

[43]  John J. Leonard,et al.  Efficient AUV navigation fusing acoustic ranging and side-scan sonar , 2011, 2011 IEEE International Conference on Robotics and Automation.

[44]  Oyvind Hegrenaes.  Autonomous Navigation for Underwater Vehicles , 2010 .

[45]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[46]  Hanumant Singh,et al.  Exactly Sparse Delayed-State Filters for View-Based SLAM , 2006, IEEE Transactions on Robotics.

[47]  John J. Leonard,et al.  Cooperative AUV Navigation using a Single Maneuvering Surface Craft , 2010, Int. J. Robotics Res..

[48]  S. Singh,et al.  Multi-band acoustic modem for the communications and navigation aid AUV , 2005, Proceedings of OCEANS 2005 MTS/IEEE.

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

[50]  Sebastian Thrun,et al.  Multi-robot SLAM with Sparse Extended Information Filers , 2003, ISRR.

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

[52]  Hugh F. Durrant-Whyte,et al.  A decentralised navigation architecture , 1998, Proceedings. 1998 IEEE International Conference on Robotics and Automation (Cat. No.98CH36146).

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

[54]  Hanumant Singh,et al.  Preliminary deep water results in single-beacon one-way-travel-time acoustic navigation for underwater vehicles , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[55]  A. P. Scherbatyuk.  The AUV positioning using ranges from one transponder LBL , 1995, 'Challenges of Our Changing Global Environment'. Conference Proceedings. OCEANS '95 MTS/IEEE.

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

[57]  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).