The paper addresses observability issues related to the general problem of single and multiple Autonomous Underwater Vehicle (AUV) localization using only range measurements. While an AUV is submerged, localization devices, such as Global Navigation Satellite Systems, are ineffective, due to the attenuation of electromagnetic waves. AUV localization based on dead reckoning techniques and the use of affordable motion sensor units is also not practical, due to divergence caused by sensor bias and drift. For these reasons, localization systems often build on trilateration algorithms that rely on the measurements of the ranges between an AUV and a set of fixed transponders using acoustic devices. Still, such solutions are often expensive, require cumbersome calibration procedures and only allow for AUV localization in an area that is defined by the geometrical arrangement of the transponders. A viable alternative for AUV localization that has recently come to the fore exploits the use of complementary information on the distance from the AUV to a single transponder, together with information provided by on-board resident motion sensors, such as, for example, depth, velocity and acceleration measurements. This concept can be extended to address the problem of relative localization between two AUVs equipped with acoustic sensors for inter-vehicle range measurements. Motivated by these developments, in this paper, we show that both the problems of absolute localization of a single vehicle and the relative localization of multiple vehicles can be treated using the same mathematical framework, and tailoring concepts of observability derived for nonlinear systems, we analyze how the performance in localization depends on the types of motion imparted to the AUVs. For this effect, we propose a well-defined observability metric and validate its usefulness, both in simulation and by carrying out experimental tests with a real marine vehicle during which the performance of an Extended Kalman Filter state observer is shown to depend on the types of motion imparted to the vehicle.
References
[1]
Larsen, M. Synthetic Long Baseline Navigation of Underwater Vehicles. Proceedings of MTS/IEEE Conference Oceans 2000, Providence, RI, USA, 11–14 September 2000; pp. 2043–2050.
[2]
Gadre, A.; Stilwell, D. Underwater Navigation in the Presence of Unknown Currents Based on Range Measurements from a Single Location. Proceedings 2005 American Control Conference, Portland, USA, 8–10 June 2005; pp. 565–661.
[3]
Bahr, A.; Leonard, J.; Fallon, M. Cooperative localization for autonomous underwater vehicles. Int. J. Robot. Res. 2009, 28, 714–728.
[4]
Webster, S.; Eustice, R.; Singh, H.; Whitcomb, L. Preliminary Deep Water Results in Single-Beacon One-Way-Travel-Time Acoustic Navigation for Underwater Vehicles. Proceedings of 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems, St. Louis, MO, USA, 10–15 October 2009; pp. 2053–2060.
[5]
Hartsfield, J. Single Transponder Range Only Navigation Geometry (STRONG) Applied to REMUS Autonomous Underwater Vehicles. Ph.D. Thesis, Massachusetts Institute of Technology and Woods Hole Oceanographic Institution, Cambridge, MA, USA, August 2005.
[6]
Gadre, A. Observability Analysis in Navigation Systems with an Underwater Vehicle Application. Ph.D. Thesis, Virginia Polytechnic Institute and State University, Blacksburg, VA, USA, 2007.
[7]
Ross, A.; Jouffroy, J. Remarks on the Observability of Single Beacon Underwater Navigation. Proceedings International Symposium on Unmanned Untethered Submersible Technology, Durham, NH, USA, August 2005.
[8]
Jouffroy, J.; Reger, J. An Algebraic Perspective to Single-Transponder Underwater Navigation. Proceedings of IEEE International Conference on Control Applications, IEEE International Symposium on Computer-Aided Control Systems Design, IEEE International Symposium on Intelligent Control, Munich, Germany, 4–6 October 2006; pp. 1789–1794.
[9]
Bahr, A. Cooperative Localization for Autonomous Underwater Vehicles. Ph.D. Thesis, Massachusetts Institute of Technology and Woods Hole Oceanographic Institution, Cambridge, MA, USA, February 2008.
[10]
Fallon, M.; Papadopoulos, G.; Leonard, J.; Patrikalakis, N. Cooperative AUV Navigation using a single maneuvering surface craft. Int.J. Robot. Res. 2010, 29, 1461–1474.
[11]
Singh, S.; Grund, M.; Bingham, B.; Eustice, R.; Singh, H.; Freitag, L. Underwater Acoustic Navigation with the WHOI Micro-Modem. Proceedings of MTS/IEEE Conference and Exhibition OCEANS 2000, Providence, RI, USA, 18–21 September 2000; pp. 1–4.
[12]
Papadopoulos, G.; Fallon, M.; Leonard, J.; Patrikalakis, N. Cooperative Localization of Marine Vehicles Using Nonlinear State Estimation. Proceedings of 2010 IEEE /RSJ International Conference on Intelligent Robots and Systems, Taipei, Taiwan, 18–22 October 2010; pp. 4874–4879.
[13]
Hong, S.; Chun, H.; Kwon, S.; Lee, M. Observability measures and their application to GPS/INS. IEEE Trans. Veh. Technol. 2008, 57, 97–106.
[14]
Saúde, J.; Aguiar, A. Single Beacon Acoustic Navigation for an AUV in the Presence of Unknown Ocean Currents. Proceedings of 8th IFAC Conference on Manoeuvring and Control of Marine Craft, Guaruja (SP), Brazil, 16–18 September 2009; pp. 298–303.
[15]
Batista, P.; Silvestre, C.; Oliveira, P. Single range aided navigation and source localization: Observability and filter design. Syst. Control Lett. 2011, 60, 665–673.
[16]
Casalino, G.; Caiti, A.; Turetta, A.; Simetti, E. RT2: Real-time ray-tracing for underwater range evaluation. Intell. Serv. Robot. 2011, 4, 259–270.
[17]
Parlangeli, G.; Pedone, P.; Indiveri, G. Relative Pose Observability Analysis for 3D Nonholonomic Vehicles Based on Range Measurements Only. Proceedings of 9th IFAC Conference on Manoeuvring and Control of Marine Craft, Arenzano (GE), Italy, 19–21 September 2012.
[18]
Chen, B.; Hu, J.; Li, H.; Sun, Z. Measure Observability by the Generalized Informational Correlation. Proceedings of 46th IEEE Conference on Decision and Control, New Orleans, LA, USA, 12–14 December 2007; pp. 5570–5574.
[19]
Jauffret, C. Observability and Fisher information matrix in nonlinear regression. IEEE Trans. Aerosp. Electron. Syst. 2007, 43, 756–759.
[20]
Grossman, W. Bearings-Only Tracking: A Hybrid Coordinate System Approach. Proceedings of the 30th IEEE Conference on Decision and Control, Brighton, UK, December 1991; pp. 2032–2037.
[21]
Passerieux, J.; van Cappel, D. Optimal observer maneuver for bearings-only tracking. IEEE Trans. Aerosp. Electron. Syst. 1998, 34, 777–788.
[22]
Martinelli, A. State estimation based on the concept of continuous symmetry and observability analysis: The case of calibration. IEEE Trans. Robot. 2011, 27, 239–255.
[23]
Sun, Y.; Hollerbach, J.M. Observability Index Selection for Robot Calibration. Proceedings of IEEE International Conference on Robotics and Automation, Pasadena, CA, USA, 19–23 May 2008; pp. 831–836.
[24]
Hermann, R.; Krener, A. Nonlinear controllability and observability. IEEE Trans. Autom. Control 1977, 22, 728–740.
[25]
Nijmeijer, H.; van der Schaft, A. Nonlinear Dynamical Control Systems; Springer: Berlin, Germany, 1990.
[26]
Zhou, X.; Roumeliotis, S. Robot-to-robot relative pose estimation from range measurements. IEEE Trans. Robot. 2008, 24, 1379–1393.
[27]
Krener, A.; Ide, K. Measures of Unobservability. Proceedings of 48th IEEE Conference on Decision and Control and 28th Chinese Control Conference, Shanghai, China, 15–18 December 2009; pp. 6401–6406.
[28]
Kang, W.; Xu, L. A Quantitative Measure of Observability and Controllability. Proceedings of 48th IEEE Conference on Decision and Control and 28th Chinese Control Conference, Shanghai, China, 15–18 December 2009; pp. 6413–6418.
[29]
Antonelli, G.; Arrichiello, F.; Chiaverini, S.; Sukhatme, G. Observability Analysis of Relative Localization for AUVs Based on Ranging and Depth Measurements. Proceedings of 2010 IEEE International Conference on Robotics and Automation, Anchorage, Alaska, USA, 3–8 May 2010; pp. 4276–4281.
[30]
Antonelli, G.; Caiti, A.; Calabr？, V.; Chiaverini, S. Designing Behaviors to Improve Observability for Relative Localization of AUVs. Proceedings of 2010 IEEE International Conference on Robotics and Automation, Anchorage, Alaska, USA, 3–8 May 2010; pp. 4270–4275.
Arrichiello, P.; Antonelli, G.; Aguiar, A.; Pascoal, A. Observability Metric for the Relative Localization of AUVs Based on Range and Depth Measurements: Theory and Experiments. Proceedings of 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems, San Francisco, CA, USA, 25–30 September 2011; pp. 3166–3171.
[33]
Sontag, E. Mathematical Control Theory: Deterministic Finite Dimensional Systems; Springer: Berlin, Germany, 1998.
[34]
Golub, G.; Loan, C.V. Matrix Computations, 3rd ed. ed.; The Johns Hopkins University Press: Baltimore, MD, USA, 1996.
