Simulation of an Inertial Acoustic Navigation System With Range Aiding for an Autonomous Underwater Vehicle

This paper presents an integrated navigation system for underwater vehicles to improve the performance of a conventional inertial acoustic navigation system by introducing range measurement. The integrated navigation system is based on a strapdown inertial navigation system (SDINS) accompanying range sensor, Doppler velocity log (DVL), magnetic compass, and depth sensor. Two measurement models of the range sensor are derived and augmented to the inertial acoustic navigation system, respectively. A multirate extended Kalman filter (EKF) is adopted to propagate the error covariance with the inertial sensors, where the filter updates the measurement errors and the error covariance and corrects the system states when the external measurements are available. This paper demonstrates the improvement on the robustness and convergence of the integrated navigation system with range aiding (RA). This paper used experimental data obtained from a rotating arm test with a fish model to simulate the navigational performance. Strong points of the navigation system are the elimination of initial position errors and the robustness on the dropout of acoustic signals. The convergence speed and conditions of the initial error removal are examined with Monte Carlo simulation. In addition, numerical simulations are conducted with the six-degrees-of-freedom (6-DOF) equations of motion of an autonomous underwater vehicle (AUV) in a boustrophedon survey mode to illustrate the effectiveness of the integrated navigation system.

[1]  Jihong Lee,et al.  Multivariable optimal control of an autonomous underwater vehicle for steering and diving control in variable speed , 2003, Oceans 2003. Celebrating the Past ... Teaming Toward the Future (IEEE Cat. No.03CH37492).

[2]  S. M. Smith,et al.  New experimental results on GPS/INS navigation for Ocean Voyager II AUV , 1996, Proceedings of Symposium on Autonomous Underwater Vehicle Technology.

[3]  Thor I. Fossen,et al.  A nonlinear observer for GPS and INS integration , 2001, Proceedings of the 40th IEEE Conference on Decision and Control (Cat. No.01CH37228).

[4]  J. Farrell,et al.  The global positioning system and inertial navigation , 1999 .

[5]  D. Yoerger,et al.  Combined Doppler/LBL Based Navigation of Underwater Vehicles , 1999 .

[6]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[7]  Daniel J. Stilwell,et al.  Toward underwater navigation based on range measurements from a single location , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[8]  Hanumant Singh,et al.  Towards Precision Robotic Maneuvering, Survey, and Manipulation in Unstructured Undersea Environments , 1998 .

[9]  D. H. Titterton,et al.  The alignment of ship launched missile IN systems , 1990 .

[10]  Sea-Moon Kim,et al.  Underwater Navigation System Based On Inertial Sensor And Doppler Velocity Log Using Indirect Feedback Kalman Filter , 2005 .

[11]  Mikael Bliksted Larsen.  Autonomous navigation of underwater vehicles , 2001 .

[12]  Sea-Moon Kim,et al.  Improvement on an inertial-Doppler navigation system of underwater vehicles using a complementary range sonar , 2004, Proceedings of the 2004 International Symposium on Underwater Technology (IEEE Cat. No.04EX869).

[13]  Paulo Oliveira,et al.  Study and implementation of an EKF GIB-based underwater positioning system , 2004 .

[14]  S. Beiter,et al.  Precision hybrid navigation system for varied marine applications , 1998, IEEE 1998 Position Location and Navigation Symposium (Cat. No.98CH36153).

[15]  G. M. Trimble.  The Doppler inertial acoustic system for littoral navigation (DIAS) , 1998, Proceedings of the 1998 Workshop on Autonomous Underwater Vehicles (Cat. No.98CH36290).

[16]  Hanumant Singh,et al.  Advances in Doppler-based navigation of underwater robotic vehicles , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[17]  J. Opderbecke,et al.  Underwater vehicle trajectory estimation using contracting PDE-based observers , 2004, Proceedings of the 2004 American Control Conference.

[18]  M. Uliana,et al.  The navigation system of an autonomous underwater vehicle for Antarctic exploration , 1997, Oceans '97. MTS/IEEE Conference Proceedings.

[19]  Arthur Gelb,et al.  Applied Optimal Estimation , 1974 .

[20]  Louis L. Whitcomb,et al.  Towards in-situ calibration of gyro and Doppler navigation sensors for precision underwater vehicle navigation , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[21]  Paulo Oliveira,et al.  Navigation systems design: an application of multi-rate filtering theory , 1998, IEEE Oceanic Engineering Society. OCEANS'98. Conference Proceedings (Cat. No.98CH36259).

[22]  Bong-Huan Jun,et al.  Pseudo long base line navigation algorithm for underwater vehicles with inertial sensors and two acoustic range measurements , 2007 .

[23]  Louis L. Whitcomb,et al.  Preliminary field experience with the DVLNAV integrated navigation system for oceanographic submersibles , 2004 .

[24]  A. J. Marco,et al.  Command, Control and Navigation: Experimental Results with the NPS , 2001 .

[25]  Sea-Moon Kim,et al.  Preliminary study on the inertial-Doppler localization of a deep-sea launcher hanging on a cable , 2003, 2003 International Conference Physics and Control. Proceedings (Cat. No.03EX708).

[26]  Robert B. McGhee,et al.  Testing and evaluation of an integrated GPS/INS system for small AUV navigation , 1999 .