Attitude Estimation of Underwater Vehicles Using Field Measurements and Bias Compensation

This paper proposes a method of estimating the attitude of an underwater vehicle. The proposed method uses two field measurements, namely, a gravitational field and a magnetic field represented in terms of vectors in three-dimensional space. In many existing methods that convert the measured field vectors into Euler angles, the yaw accuracy is affected by the uncertainty of the gravitational measurement and by the uncertainty of the magnetic field measurement. Additionally, previous methods have used the magnetic field measurement under the assumption that the magnetic field has only a horizontal component. The proposed method utilizes all field measurement components as they are, without converting them into Euler angles. The bias in the measured magnetic field vector is estimated and compensated to take full advantage of all measured field vector components. Because the proposed method deals with the measured field independently, uncertainties in the measured vectors affect the attitude estimation separately without adding up. The proposed method was tested by conducting navigation experiments with an unmanned underwater vehicle inside test tanks. The results were compared with those obtained by other methods, wherein the Euler angles converted from the measured field vectors were used as measurements.

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

[2]  Tae Suk Yoo,et al.  Gain-Scheduled Complementary Filter Design for a MEMS Based Attitude and Heading Reference System , 2011, Sensors.

[3]  Lei Yan,et al.  A Support Vector Learning-Based Particle Filter Scheme for Target Localization in Communication-Constrained Underwater Acoustic Sensor Networks , 2017, Sensors.

[4]  Axel Barrau,et al.  The Invariant Extended Kalman Filter as a Stable Observer , 2014, IEEE Transactions on Automatic Control.

[5]  A. Chulliat,et al.  The US/UK World Magnetic Model for 2015-2020 , 2015 .

[6]  Nak Yong Ko,et al.  Sine Rotation Vector Method for Attitude Estimation of an Underwater Robot , 2016, Sensors.

[7]  Luigi Chisci,et al.  An unscented Kalman filter based navigation algorithm for autonomous underwater vehicles , 2016 .

[8]  Giancarlo Troni,et al.  Preliminary experimental evaluation of a Doppler-aided attitude estimator for improved Doppler navigation of underwater vehicles , 2013, 2013 IEEE International Conference on Robotics and Automation.

[9]  Peter Kazanzides,et al.  Investigation of Attitude Tracking Using an Integrated Inertial and Magnetic Navigation System for Hand-Held Surgical Instruments , 2012, IEEE/ASME Transactions on Mechatronics.

[10]  Benedetto Allotta,et al.  An Attitude Estimation Algorithm for Mobile Robots Under Unknown Magnetic Disturbances , 2016, IEEE/ASME Transactions on Mechatronics.

[11]  Axel Barrau,et al.  Invariant Kalman Filtering , 2018, Annu. Rev. Control. Robotics Auton. Syst..

[12]  Martin Barczyk Nonlinear State Estimation and Modeling of a Helicopter UAV , 2012 .

[13]  J. Junkins,et al.  Optimal Estimation of Dynamic Systems , 2004 .

[14]  Mark Euston,et al.  A complementary filter for attitude estimation of a fixed-wing UAV , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Benedetto Allotta,et al.  A new AUV navigation system exploiting unscented Kalman filter , 2016 .

[16]  Philippe Martin,et al.  Invariant Extended Kalman Filter: theory and application to a velocity-aided attitude estimation problem , 2009, Proceedings of the 48h IEEE Conference on Decision and Control (CDC) held jointly with 2009 28th Chinese Control Conference.

[17]  Antonio M. Pascoal,et al.  Robust particle filter formulations with application to terrain‐aided navigation , 2017 .

[18]  John L. Crassidis,et al.  Real-Time Attitude-Independent Three-Axis Magnetometer Calibration , 2005 .

[19]  Robert B. McGhee,et al.  A Simplified Quaternion-Based Algorithm for Orientation Estimation From Earth Gravity and Magnetic Field Measurements , 2008, IEEE Transactions on Instrumentation and Measurement.

[20]  Bo Wang,et al.  A Particle Filter-Based Matching Algorithm With Gravity Sample Vector for Underwater Gravity Aided Navigation , 2016, IEEE/ASME Transactions on Mechatronics.

[21]  Susan Macmillan,et al.  The US/UK World Magnetic Model for 2020-2025 : Technical Report , 2020 .

[22]  M. Shuster,et al.  Three-axis attitude determination from vector observations , 1981 .

[23]  Giancarlo Troni,et al.  Adaptive Estimation of Measurement Bias in Three-Dimensional Field Sensors with Angular Rate Sensors: Theory and Comparative Experimental Evaluation , 2013, Robotics: Science and Systems.

[24]  Benedetto Allotta,et al.  UKF-Based Navigation System for AUVs: Online Experimental Validation , 2019, IEEE Journal of Oceanic Engineering.

[25]  Chin-Sheng Chen,et al.  Motion and attitude estimation using inertial measurements with complementary filter , 2011, 2011 8th Asian Control Conference (ASCC).

[26]  Lu Wang,et al.  Polar Grid Navigation Algorithm for Unmanned Underwater Vehicles , 2017, Sensors.