Hydroacoustically aided inertial navigation for joint position and attitude estimation in absence of magnetic field measurements

When an underwater intervention vehicle is close to large metallic structures, e.g. subsea oil and gas facilities, magnetic disturbances might render magnetic field measurements biased or useless. This loss of information is critical for attitude estimation, and consequently, for the safety of the operation. In this paper, a three-stage filter for joint position and attitude estimation is developed, replacing the magnetic field measurements with hydroacoustic measurements. This solution assumes a hydroacoustic sensor set up with multiple transponders on the sea floor and 3 or more transceivers on the vehicle. The three-stage filters is shown to yield GES error dynamics of both the translational and rotational motion. The three-stage filter is shown in simulations to successfully estimate both the true position and attitude of the vehicle.

[1]  Tor Arne Johansen,et al.  Globally exponentially stable attitude and gyro bias estimation with application to GNSS/INS integration , 2015, Autom..

[2]  Graham C. Goodwin,et al.  Three-stage filter for position estimation using pseudorange measurements , 2016, IEEE Transactions on Aerospace and Electronic Systems.

[3]  Tor Arne Johansen,et al.  Three-stage filter for position and velocity estimation from long baseline measurements with unknown wave speed , 2016, 2016 American Control Conference (ACC).

[4]  Mark L. Neudorfer.  A Transponder Array Survey Method Using A Combined Shortbaseline/Long-Baseline Acoustic Position Reference System , 1978 .

[5]  J. Meyer,et al.  Generalized Inverses and Ranks of Block Matrices , 1973 .

[6]  R. E. Kalman,et al.  New Results in Linear Filtering and Prediction Theory , 1961 .

[7]  Robert E. Mahony,et al.  Attitude estimation on SO[3] based on direct inertial measurements , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[8]  Tor Arne Johansen,et al.  A nonlinear observer for integration of GNSS and IMU measurements with gyro bias estimation , 2012, 2012 American Control Conference (ACC).

[9]  Tor Arne Johansen,et al.  The eXogenous Kalman Filter (XKF) , 2017, Int. J. Control.

[10]  Tor Arne Johansen,et al.  Nonlinear filtering with exogenous Kalman filter and double Kalman filter , 2016, 2016 European Control Conference (ECC).

[11]  Tor Arne Johansen,et al.  Attitude Estimation Using Biased Gyro and Vector Measurements With Time-Varying Reference Vectors , 2012, IEEE Transactions on Automatic Control.

[12]  K. Gade,et al.  Underwater transponder positioning and navigation of autonomous underwater vehicles , 2009, OCEANS 2009.

[13]  S. Bancroft.  An Algebraic Solution of the GPS Equations , 1985, IEEE Transactions on Aerospace and Electronic Systems.

[14]  K. Vickery,et al.  Acoustic positioning systems. A practical overview of current systems , 1998, Proceedings of the 1998 Workshop on Autonomous Underwater Vehicles (Cat. No.98CH36290).

[15]  Claes Johnson.  Uniform Numerical Methods for Problems with Initial and Boundary Layers (E. P. Doolan, J. J. H. Miller and W. H. A. Schilders) , 1983 .

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

[17]  Robert E. Mahony,et al.  Nonlinear Complementary Filters on the Special Orthogonal Group , 2008, IEEE Transactions on Automatic Control.

[18]  Tor Arne Johansen,et al.  Globally exponentially stable aided inertial navigation with hydroacoustic measurements from a single transponder , 2017, 2017 American Control Conference (ACC).

[19]  Minh-Duc Hua.  Attitude estimation for accelerated vehicles using GPS/INS measurements , 2010 .

[20]  Elena Panteley,et al.  Cascaded nonlinear time-varying systems : Analysis and design , 2005 .

[21]  Carlos Silvestre,et al.  GES integrated LBL/USBL navigation system for underwater vehicles , 2012, 2012 IEEE 51st IEEE Conference on Decision and Control (CDC).