Single axis FOG aided attitude estimation algorithm for mobile robots

Abstract This paper is focused on an attitude estimation method for Autonomous Underwater Vehicles (AUVs). Data acquired by a commercial Micro-Electro-Mechanical Systems (MEMS) Inertial Measurement Unit (IMU), equipped with magnetometers, and a Fibre Optic Gyroscope (FOG) are fused to estimate the attitude of the vehicle. One of the most used attitude estimation filter, a Nonlinear Complementary Filter (NCF), is proposed as the basis of this work; then, some adaptations to the original formulation of the filter are illustrated to better suit it to the field of underwater robotics. The proposed improvements include the online tuning of the gains of the filter to cope with sensor disturbances and the employment of the data acquired by a FOG. In addition, a fast procedure for the calibration of a magnetometer is introduced to increase the reliability of its readings. The resulting filter is used to estimate the attitude of an AUV; the performance of the proposed solution is tested and evaluated, in particular when unpredictable magnetic disturbances are present, highlighting the improvements that the applied changes allow to achieve in the specific field of application.

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

[2]  J.L. Crassidis,et al.  Sigma-point Kalman filtering for integrated GPS and inertial navigation , 2005, IEEE Transactions on Aerospace and Electronic Systems.

[3]  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).

[4]  Thia Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation: Theory, Algorithms and Software , 2001 .

[5]  Philippe Martin,et al.  Design and implementation of a low-cost observer-based attitude and heading reference system , 2010 .

[6]  Konrad Rudin,et al.  Nonlinear attitude estimation with measurement decoupling and anti-windup gyro-bias compensation , 2011 .

[7]  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.

[8]  John L. Crassidis,et al.  Predictive filtering for attitude estimation without rate sensors , 1997 .

[9]  Ilya V. Kolmanovsky,et al.  Predictive energy management of a power-split hybrid electric vehicle , 2009, 2009 American Control Conference.

[10]  Carlos Silvestre,et al.  Attitude and earth velocity estimation - Part I: Globally exponentially stable observer , 2014, 53rd IEEE Conference on Decision and Control.

[11]  Ovidio Salvetti,et al.  The ARROWS project: adapting and developing robotics technologies for underwater archaeology , 2015 .

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

[13]  R. Halír.  Numerically Stable Direct Least Squares Fitting of Ellipses , 1998 .

[14]  Benedetto Allotta,et al.  Preliminary design and fast prototyping of an Autonomous Underwater Vehicle propulsion system , 2015 .

[15]  Benedetto Allotta,et al.  Cooperative localization of a team of AUVs by a tetrahedral configuration , 2014, Robotics Auton. Syst..

[16]  Pietro Falco,et al.  Experimental Comparison of Sensor Fusion Algorithms for Attitude Estimation , 2014 .

[17]  Andrew W. Fitzgibbon,et al.  Direct Least Square Fitting of Ellipses , 1999, IEEE Trans. Pattern Anal. Mach. Intell..

[18]  Carlos Silvestre,et al.  Sensor-Based Globally Asymptotically Stable Filters for Attitude Estimation: Analysis, Design, and Performance Evaluation , 2012, IEEE Transactions on Automatic Control.

[19]  Jeffrey K. Uhlmann,et al.  New extension of the Kalman filter to nonlinear systems , 1997, Defense, Security, and Sensing.