Fusing Hydroacoustic Absolute Position Fixes with AUV On-Board Dead Reckoning

Abstract This paper presents an implementation of the Sigma-point Unscented Kalman Filter (SP-UKF) used in the simulated task of open-water navigation of a large cruise-type autonomous underwater vehicle (AUV), the NPS * Aries. Open-water navigation is conducted on the basis of rate gyros, the AHRS ** , which includes accelerometers and a triaxial magnetic compass, and the DVL *** . All sensors function at many times the sampling time of the control loops, and therefore are available (with even the possibility of median or other filtering) at every sample time. Additionally, to correct for unavoidable dead reckoning drift, an inverted USBL **** system is used to sporadically fuse an absolute navigation fix with the projected solution of the dead reckoning navigation. The entire simulation environment includes a detailed dynamical model of the vehicle, non-stationary, non-Gaussian measurement noise generators, sporadic sensor failure and sliding mode controllers for heading, pitch and forward speed.

[1]  N. Fisher,et al.  Efficient Simulation of the von Mises Distribution , 1979 .

[2]  Carlos Silvestre,et al.  Design and experimental evaluation of an integrated USBL/INS system for AUVs , 2010, 2010 IEEE International Conference on Robotics and Automation.

[3]  D. Owen.  Handbook of Mathematical Functions with Formulas , 1965 .

[4]  R. Kálmán.  On the general theory of control systems , 1959 .

[5]  Norbert Wiener,et al.  Extrapolation, Interpolation, and Smoothing of Stationary Time Series, with Engineering Applications , 1949 .

[6]  Claudio Agostinelli,et al.  circular: Circular Statistics, from "Topics in circular Statistics" (2001) S. Rao Jammalamadaka and A. SenGupta, World Scientific. , 2004 .

[7]  L. Rabiner,et al.  An introduction to hidden Markov models , 1986, IEEE ASSP Magazine.

[8]  Matko Barišić.  Guidance of formations of autonomous underwater vehicles by virtual potential method , 2012 .

[9]  A. J. Healey,et al.  Modeling, Sliding Mode Control Design, and Visual Simulation of Auv Dive Plane Dynamic Response , 1989, Proceedings of the 6th International Symposium on Unmanned Untethered Submersible Technology,.

[10]  K. Vickery.  Acoustic positioning systems. New concepts-the future , 1998, Proceedings of the 1998 Workshop on Autonomous Underwater Vehicles (Cat. No.98CH36290).

[11]  A. J. Healey,et al.  Multivariable sliding mode control for autonomous diving and steering of unmanned underwater vehicles , 1993 .

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

[13]  R. E. Kalman,et al.  A New Approach to Linear Filtering and Prediction Problems , 2002 .

[14]  Rudolph van der Merwe,et al.  Sigma-point kalman filters for probabilistic inference in dynamic state-space models , 2004 .