AUV Navigation and Localization: A Review

Autonomous underwater vehicle (AUV) navigation and localization in underwater environments is particularly challenging due to the rapid attenuation of Global Positioning System (GPS) and radio-frequency signals. Underwater communications are low bandwidth and unreliable, and there is no access to a global positioning system. Past approaches to solve the AUV localization problem have employed expensive inertial sensors, used installed beacons in the region of interest, or required periodic surfacing of the AUV. While these methods are useful, their performance is fundamentally limited. Advances in underwater communications and the application of simultaneous localization and mapping (SLAM) technology to the underwater realm have yielded new possibilities in the field. This paper presents a review of the state of the art of AUV navigation and localization, as well as a description of some of the more commonly used methods. In addition, we highlight areas of future research potential.

[1]  Takuya Shimura,et al.  A study of inverse SSBL acoustic positioning with data transmission for multiple AUV navigation , 2012, 2012 Oceans - Yeosu.

[2]  F S Hover,et al.  Accurate geo-referencing method for AUVs for oceanographic sampling , 2010, OCEANS 2010 MTS/IEEE SEATTLE.

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

[4]  M. Grund,et al.  Experiments in moving baseline navigation using autonomous surface craft , 2005, Proceedings of OCEANS 2005 MTS/IEEE.

[5]  O. Pizarro,et al.  Visually Augmented Navigation for Autonomous Underwater Vehicles , 2008, IEEE Journal of Oceanic Engineering.

[6]  Carl E. Rasmussen,et al.  Gaussian processes for machine learning , 2005, Adaptive computation and machine learning.

[7]  Tao Zhang,et al.  An autonomous navigation algorithm for underwater vehicles based on inertial measurement units and sonar , 2010, 2010 2nd International Asia Conference on Informatics in Control, Automation and Robotics (CAR 2010).

[8]  Tom Duckett,et al.  A multilevel relaxation algorithm for simultaneous localization and mapping , 2005, IEEE Transactions on Robotics.

[9]  Mandar A. Chitre Path planning for cooperative underwater range-only navigation using a single beacon , 2010, 2010 International Conference on Autonomous and Intelligent Systems, AIS 2010.

[10]  John J. Leonard,et al.  Towards Constant-Time SLAM on an Autonomous Underwater Vehicle Using Synthetic Aperture Sonar , 2003, ISRR.

[11]  Kostas J. Kyriakopoulos,et al.  On-line state and parameter estimation of an under-actuated underwater vehicle using a modified Dual Unscented Kalman Filter , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[13]  Pere Ridao,et al.  Visual inspection of hydroelectric dams using an autonomous underwater vehicle , 2010, J. Field Robotics.

[14]  Peter Cheeseman,et al.  On the Representation and Estimation of Spatial Uncertainty , 1986 .

[15]  Geoffrey A. Hollinger,et al.  Towards Improved Prediction of Ocean Processes Using Statistical Machine Learning , 2012, RSS 2012.

[16]  Gaurav S. Sukhatme,et al.  Opportunistic localization of underwater robots using drifters and boats , 2012, 2012 IEEE International Conference on Robotics and Automation.

[17]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

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

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

[20]  Stefan B. Williams,et al.  Efficient View-Based SLAM Using Visual Loop Closures , 2008, IEEE Transactions on Robotics.

[21]  Chris Murphy,et al.  Long-baseline acoustic navigation for under-ice autonomous underwater vehicle operations , 2008 .

[22]  Michael Bosse,et al.  Map Matching and Data Association for Large-Scale Two-dimensional Laser Scan-based SLAM , 2008, Int. J. Robotics Res..

[23]  Stergios I. Roumeliotis,et al.  Distributed Maximum A Posteriori Estimation for Multi-robot Cooperative Localization , 2009 .

[24]  Evangelos E. Milios,et al.  Globally Consistent Range Scan Alignment for Environment Mapping , 1997, Auton. Robots.

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

[26]  Stergios I. Roumeliotis,et al.  Observability-based consistent EKF estimators for multi-robot cooperative localization , 2011, Auton. Robots.

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

[28]  E. Olson,et al.  Robust Range-Only Beacon Localization , 2004, IEEE Journal of Oceanic Engineering.

[29]  Franz S. Hover,et al.  Imaging sonar-aided navigation for autonomous underwater harbor surveillance , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[30]  Einar Berglund,et al.  Doppler water-track aided inertial navigation for autonomous underwater vehicle , 2009, OCEANS 2009-EUROPE.

[31]  Joaquim Salvi,et al.  Robust automatic landmark detection for underwater SLAM using side-scan sonar imaging , 2011 .

[32]  Peter I. Corke,et al.  Experiments with Underwater Robot Localization and Tracking , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

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

[34]  Cyrill Stachniss,et al.  Hierarchical optimization on manifolds for online 2D and 3D mapping , 2010, 2010 IEEE International Conference on Robotics and Automation.

[35]  B. P. Howell,et al.  Passive sonar recognition and analysis using hybrid neural networks , 2003, Oceans 2003. Celebrating the Past ... Teaming Toward the Future (IEEE Cat. No.03CH37492).

[36]  Edwin Olson,et al.  Fast iterative alignment of pose graphs with poor initial estimates , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[37]  Franz S. Hover,et al.  Advanced perception, navigation and planning for autonomous in-water ship hull inspection , 2012, Int. J. Robotics Res..

[38]  Dean B Edwards,et al.  Synchronous navigation of AUVs using WHOI micro-modem 13-bit communications , 2010, OCEANS 2010 MTS/IEEE SEATTLE.

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

[40]  Luc Jaulin A Nonlinear Set Membership Approach for the Localization and Map Building of Underwater Robots , 2009, IEEE Transactions on Robotics.

[41]  John J. Leonard,et al.  Cooperative localization of marine vehicles using nonlinear state estimation , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[42]  Hanumant Singh,et al.  Towards High-resolution Imaging from Underwater Vehicles , 2007, Int. J. Robotics Res..

[43]  Chris Murphy,et al.  Long‐baseline acoustic navigation for under‐ice autonomous underwater vehicle operations , 2008, J. Field Robotics.

[44]  Y. Petillot,et al.  Concurrent mapping and localization using sidescan sonar , 2004, IEEE Journal of Oceanic Engineering.

[45]  Hugh Durrant-Whyte,et al.  Simultaneous localization and mapping (SLAM): part II , 2006 .

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

[47]  Marco Piras,et al.  Performances comparison of different MEMS-based IMUs , 2010, IEEE/ION Position, Location and Navigation Symposium.

[48]  Carlos Silvestre,et al.  Optimal position and velocity navigation filters for autonomous vehicles , 2010, Autom..

[49]  Cordelia Schmid,et al.  A Comparison of Affine Region Detectors , 2005, International Journal of Computer Vision.

[50]  Stefan B. Williams,et al.  An efficient approach to bathymetric SLAM , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[51]  Ryan M. Eustice,et al.  Real-Time Visual SLAM for Autonomous Underwater Hull Inspection Using Visual Saliency , 2013, IEEE Transactions on Robotics.

[52]  David Wettergreen,et al.  Real‐Time SLAM with Octree Evidence Grids for Exploration in Underwater Tunnels , 2007, J. Field Robotics.

[53]  Jesse Pentzer,et al.  Field measurement of surface ship magnetic signature using multiple AUVs , 2009, OCEANS 2009.

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

[55]  Wolfram Burgard,et al.  Improved Techniques for Grid Mapping With Rao-Blackwellized Particle Filters , 2007, IEEE Transactions on Robotics.

[56]  Stergios I. Roumeliotis,et al.  Cooperative multi-robot localization under communication constraints , 2009, 2009 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).

[58]  B Ferreira,et al.  Single beacon navigation: Localization and control of the MARES AUV , 2010, OCEANS 2010 MTS/IEEE SEATTLE.

[59]  Wolfram Burgard,et al.  Nonlinear Constraint Network Optimization for Efficient Map Learning , 2009, IEEE Transactions on Intelligent Transportation Systems.

[60]  John J. Leonard,et al.  Pure range-only sub-sea SLAM , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[61]  Gabriel Oliver,et al.  A Bayesian approach for tracking undersea narrow telecommunication cables , 2009, OCEANS 2009-EUROPE.

[62]  John J. Leonard,et al.  Autonomous Underwater Vehicle Navigation , 2016 .

[63]  Franz S. Hover,et al.  SLAM for ship hull inspection using exactly sparse extended information filters , 2008, 2008 IEEE International Conference on Robotics and Automation.

[64]  Joaquim Salvi,et al.  Acoustic-Based Techniques for Autonomous Underwater Vehicle Localization , 2010 .

[65]  Y. Petillot,et al.  Visual SLAM for underwater vehicles using video velocity log and natural landmarks , 2008, OCEANS 2008.

[66]  R. Zimmerman,et al.  Absolute positioning of an autonomous underwater vehicle using GPS and acoustic measurements , 2005, IEEE Journal of Oceanic Engineering.

[67]  Matthew R. Walter,et al.  Exactly Sparse Extended Information Filters for Feature-based SLAM , 2007, Int. J. Robotics Res..

[68]  Feng Sun,et al.  Enhancement of the Aided Inertial Navigation System for an AUV via micronavigation , 2010, OCEANS 2010 MTS/IEEE SEATTLE.

[69]  David Wettergreen,et al.  Autonomous Exploration and Mapping of Flooded Sinkholes , 2010, Int. J. Robotics Res..

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

[71]  T. Shimura,et al.  A tracking of AUV with integration of SSBL acoustic positioning and transmitted INS data , 2009, OCEANS 2009-EUROPE.

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

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

[74]  Joaquim Salvi,et al.  Selective Submap Joining for underwater large scale 6-DOF SLAM , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[75]  Pere Ridao,et al.  Delayed state information filter for USBL-Aided AUV navigation , 2012, 2012 IEEE International Conference on Robotics and Automation.

[76]  Pere Ridao,et al.  Underwater SLAM in man-made structured environments , 2008 .

[77]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[78]  Carrick Detweiler,et al.  AMOUR V: A Hovering Energy Efficient Underwater Robot Capable of Dynamic Payloads , 2010, Int. J. Robotics Res..

[79]  Hanumant Singh,et al.  Visually Mapping the RMS Titanic: Conservative Covariance Estimates for SLAM Information Filters , 2006, Int. J. Robotics Res..

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

[81]  Cara Elizabeth Grupe LaPointe,et al.  Virtual long baseline (VLBL) autonomous underwater vehicle navigation using a single transponder , 2006 .

[82]  L.L. Whitcomb,et al.  In Situ Alignment Calibration of Attitude and Doppler Sensors for Precision Underwater Vehicle Navigation: Theory and Experiment , 2007, IEEE Journal of Oceanic Engineering.

[83]  Carlos Silvestre,et al.  Position and velocity filters for intervention AUVs based on single range and depth measurements , 2012, 2012 IEEE International Conference on Robotics and Automation.

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

[85]  Stefan B. Williams,et al.  Generation and visualization of large‐scale three‐dimensional reconstructions from underwater robotic surveys , 2010, J. Field Robotics.

[86]  Pere Ridao,et al.  SLAM using an Imaging Sonar for Partially Structured Underwater Environments , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[87]  B.D.O. Anderson,et al.  Optimal Range-Difference-Based Localization Considering Geometrical Constraints , 2008, IEEE Journal of Oceanic Engineering.

[88]  Pere Ridao,et al.  Probabilistic sonar scan matching SLAM for underwater environment , 2010, OCEANS'10 IEEE SYDNEY.

[89]  Rafael García,et al.  Augmented state–extended Kalman filter combined framework for topology estimation in large‐area underwater mapping , 2010, J. Field Robotics.

[90]  Joaquim Salvi,et al.  Visual SLAM for 3D large-scale seabed acquisition employing underwater vehicles , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[92]  Franck Petit,et al.  Deterministic Robot-Network Localization is Hard , 2010, IEEE Transactions on Robotics.

[93]  Andreas Birk,et al.  Plane-based registration of sonar data for underwater 3D mapping , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[94]  Liam Paull,et al.  Neural network-based multiple robot Simultaneous Localization and Mapping , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[95]  Pere Ridao,et al.  Pose-based SLAM with probabilistic scan matching algorithm using a mechanical scanned imaging sonar , 2009, OCEANS 2009-EUROPE.

[96]  Chris Murphy,et al.  Toward extraplanetary under‐ice exploration: Robotic steps in the Arctic , 2009, J. Field Robotics.

[97]  Stephen Barkby,et al.  Incorporating prior maps with Bathymetric Distributed Particle SLAM for improved AUV navigation and mapping , 2009, OCEANS 2009.

[98]  Gordon Wyeth,et al.  Spatial cognition for robots , 2009, IEEE Robotics & Automation Magazine.

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

[100]  W. J. Kirkwood,et al.  Development of the DORADO mapping vehicle for multibeam, subbottom, and sidescan science missions , 2007, J. Field Robotics.

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

[102]  Gabriel Oliver,et al.  AUV navigation through turbulent ocean environments supported by onboard H-ADCP , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[103]  Alexander F. Shchepetkin,et al.  The regional oceanic modeling system (ROMS): a split-explicit, free-surface, topography-following-coordinate oceanic model , 2005 .

[104]  A Folk,et al.  Autonomous underwater vehicle navigation using moving baseline on a target ship , 2010, OCEANS 2010 MTS/IEEE SEATTLE.

[105]  Lee Freitag,et al.  Autonomous Underwater Vehicle Operations Beneath Coastal Sea Ice , 2012, IEEE/ASME Transactions on Mechatronics.

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

[107]  Carlos Silvestre,et al.  Tightly coupled ultrashort baseline and inertial navigation system for underwater vehicles: An experimental validation , 2013, J. Field Robotics.

[108]  Stefan B. Williams,et al.  Bathymetric particle filter SLAM using trajectory maps , 2012, Int. J. Robotics Res..

[109]  Pere Ridao,et al.  Probabilistic sonar scan matching for an AUV , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[110]  G. T. Donovan,et al.  Position Error Correction for an Autonomous Underwater Vehicle Inertial Navigation System (INS) Using a Particle Filter , 2012, IEEE Journal of Oceanic Engineering.

[111]  M. Jonsson,et al.  Position Correction Using Echoes From a Navigation Fix for Synthetic Aperture Sonar Imaging , 2009, IEEE Journal of Oceanic Engineering.

[112]  Brian Bingham,et al.  Hypothesis grids: improving long baseline navigation for autonomous underwater vehicles , 2006, IEEE Journal of Oceanic Engineering.

[113]  Luc Van Gool,et al.  Speeded-Up Robust Features (SURF) , 2008, Comput. Vis. Image Underst..

[114]  Brian Bingham,et al.  Predicting the navigation performance of underwater vehicles , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[115]  Honghai Liu,et al.  Navigation Technologies for Autonomous Underwater Vehicles , 2008, IEEE Transactions on Systems, Man, and Cybernetics, Part C (Applications and Reviews).

[116]  Andreas Birk,et al.  Uncertainty estimation for a 6-DoF spectral registration method as basis for sonar-based underwater 3D SLAM , 2012, 2012 IEEE International Conference on Robotics and Automation.

[117]  Gaurav S. Sukhatme,et al.  Relaxation on a mesh: a formalism for generalized localization , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[118]  Andreas Birk,et al.  An efficient strategy for data exchange in multi-robot mapping under underwater communication constraints , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[119]  John J. Leonard,et al.  Passive Mobile Robot Localization within a Fixed Beacon Field , 2006, WAFR.

[120]  Andreas Birk,et al.  Spectral registration of noisy sonar data for underwater 3D mapping , 2011, Auton. Robots.

[121]  O Hegrenaes,et al.  Model-Aided INS With Sea Current Estimation for Robust Underwater Navigation , 2011, IEEE Journal of Oceanic Engineering.

[122]  Pere Ridao,et al.  EKF-SLAM for AUV navigation under probabilistic sonar scan-matching , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[123]  Dana R. Yoerger,et al.  Navigation and control of the Nereus hybrid underwater vehicle for global ocean science to 10,903 m depth: Preliminary results , 2010, 2010 IEEE International Conference on Robotics and Automation.

[124]  Carlos Silvestre,et al.  A Sensor-Based Controller for Homing of Underactuated AUVs , 2009, IEEE Transactions on Robotics.

[125]  Stergios I. Roumeliotis,et al.  Performance analysis of multirobot Cooperative localization , 2006, IEEE Transactions on Robotics.

[126]  David G. Lowe,et al.  Object recognition from local scale-invariant features , 1999, Proceedings of the Seventh IEEE International Conference on Computer Vision.

[127]  E Gallimore,et al.  The WHOI micromodem-2: A scalable system for acoustic communications and networking , 2010, OCEANS 2010 MTS/IEEE SEATTLE.

[128]  Lee Freitag,et al.  Passive and active acoustics using an autonomous wave glider , 2012, J. Field Robotics.

[129]  Hugh F. Durrant-Whyte,et al.  Simultaneous localization and mapping: part I , 2006, IEEE Robotics & Automation Magazine.

[130]  David S. Wettergreen,et al.  Active localization on the ocean floor with multibeam sonar , 2008, OCEANS 2008.

[131]  Ryan M. Eustice,et al.  Large-area visually augmented navigation for autonomous underwater vehicles , 2005 .

[132]  Ryan M. Eustice,et al.  Pose-graph visual SLAM with geometric model selection for autonomous underwater ship hull inspection , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[133]  Stefan B. Williams,et al.  A featureless approach to efficient bathymetric SLAM using distributed particle mapping , 2011, J. Field Robotics.

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

[135]  Peter I. Corke,et al.  Experiments with Cooperative Control of Underwater Robots , 2009, Int. J. Robotics Res..

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

[137]  T. Sakamaki,et al.  Imaging vent fields: SLAM based navigation scheme for an AUV toward large-area seafloor imaging , 2008, 2008 IEEE/OES Autonomous Underwater Vehicles.

[138]  Gaurav S. Sukhatme,et al.  Observability analysis of relative localization for AUVs based on ranging and depth measurements , 2010, 2010 IEEE International Conference on Robotics and Automation.

[139]  Brian Bingham,et al.  Techniques for Deep Sea Near Bottom Survey Using an Autonomous Underwater Vehicle , 2007, Int. J. Robotics Res..

[140]  Mandar Chitre,et al.  Cooperative positioning using range-only measurements between two AUVs , 2010, OCEANS'10 IEEE SYDNEY.

[141]  A. Matos,et al.  AUV navigation and guidance in a moving acoustic network , 2005, Europe Oceans 2005.

[142]  A. S. Gadre,et al.  OBSERVABILITY ANALYSIS IN NAVIGATION SYSTEMS WITH AN UNDERWATER VEHICLE APPLICATION , 2007 .

[143]  P. Woock Survey on suitable 3D features for sonar-based underwater navigation , 2012, 2012 Oceans - Yeosu.

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

[145]  Pere Ridao,et al.  Underwater SLAM in a marina environment , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[146]  Paul T. Boggs,et al.  Sequential Quadratic Programming , 1995, Acta Numerica.

[147]  D.B. Edwards,et al.  AUV navigation in the presence of a magnetic disturbance with an extended Kalman filter , 2010, OCEANS'10 IEEE SYDNEY.