Improved Attitude and Heading Accuracy with Double Quaternion Parameters Estimation and Magnetic Disturbance Rejection

The use of unmanned aerial vehicle (UAV) applications has grown rapidly over the past decade with the introduction of low-cost microelectromechanical system (MEMS)-based sensors that measure angular velocity, gravity, and magnetic field, which are important for an object orientation determination. However, the use of low-cost sensors has also been limited because their readings are easily distorted by unwanted internal and/or external noise signals such as environmental magnetic disturbance, which lead to errors in attitude and heading estimation results. In an extended Kalman filter (EKF) process, this study proposes a method for mitigating the effect of magnetic disturbance on attitude determination by using a double quaternion parameters for representation of orientation states, which decouples the magnetometer from attitude computation. Additionally, an online measurement error covariance matrix tuning system was implemented to reject the impact of magnetic disturbance on the heading estimation. Simulation and experimental tests were conducted to verify the performance of the proposed methods in resolving the magnetic noise effect on attitude and heading. The results showed that the proposed method performed better than complimentary, gradient descent, and single quaternion-based EKF.

[1]  Sebastian O. H. Madgwick,et al.  An efficient orientation filter for inertial and inertial / magnetic sensor arrays , 2010 .

[2]  Dong Seog Han,et al.  Performance Analysis of Sensor Fusion Techniques for Heading Estimation Using Smartphone Sensors , 2019, IEEE Sensors Journal.

[3]  Jin Wu,et al.  Novel MARG-Sensor Orientation Estimation Algorithm Using Fast Kalman Filter , 2017, J. Sensors.

[4]  Ákos Odry,et al.  A Novel Fuzzy-Adaptive Extended Kalman Filter for Real-Time Attitude Estimation of Mobile Robots , 2020, Sensors.

[5]  Angelo M. Sabatini,et al.  Quaternion-based extended Kalman filter for determining orientation by inertial and magnetic sensing , 2006, IEEE Transactions on Biomedical Engineering.

[6]  Hyeonseung Im,et al.  Measurement Noise Recommendation for Efficient Kalman Filtering over a Large Amount of Sensor Data , 2019, Sensors.

[7]  Fernando López-Peña,et al.  A Kalman Filter for Nonlinear Attitude Estimation Using Time Variable Matrices and Quaternions , 2020, Sensors.

[8]  Malcolm D. Shuster.  Survey of attitude representations , 1993 .

[9]  F. Markley.  Attitude Error Representations for Kalman Filtering , 2003 .

[10]  Patrick Lacouture,et al.  Identification of Noise Covariance Matrices to Improve Orientation Estimation by Kalman Filter , 2018, Sensors.

[11]  Alejandro F. Villaverde,et al.  Nonlinear observability algorithms with known and unknown inputs: analysis and implementation , 2020, Mathematics.

[12]  Rene Landry,et al.  Accuracy Improvement of Attitude Determination Systems Using EKF-Based Error Prediction Filter and PI Controller , 2020, Sensors.

[13]  Li Wang,et al.  Quaternion-Based Kalman Filter for AHRS Using an Adaptive-Step Gradient Descent Algorithm , 2015 .

[14]  Jizhong Xiao,et al.  Keeping a Good Attitude: A Quaternion-Based Orientation Filter for IMUs and MARGs , 2015, Sensors.

[16]  Xiaoming Zhang,et al.  A New Quaternion-Based Kalman Filter for Real-Time Attitude Estimation Using the Two-Step Geometrically-Intuitive Correction Algorithm , 2017, Sensors.

[17]  Chris J. Bleakley,et al.  Accurate Orientation Estimation Using AHRS under Conditions of Magnetic Distortion , 2014, Sensors.

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

[19]  Tamir Hazan,et al.  Gravity-Based Methods for Heading Computation in Pedestrian Dead Reckoning , 2019, Sensors.

[20]  Angelo M. Sabatini,et al.  Kalman-Filter-Based Orientation Determination Using Inertial/Magnetic Sensors: Observability Analysis and Performance Evaluation , 2011, Sensors.

[21]  Sheng Liu,et al.  Quaternion-Based Unscented Kalman Filter for Accurate Indoor Heading Estimation Using Wearable Multi-Sensor System , 2015, Sensors.

[22]  Tao Liu,et al.  How Magnetic Disturbance Influences the Attitude and Heading in Magnetic and Inertial Sensor-Based Orientation Estimation , 2017, Sensors.

[23]  Marion Gebhard,et al.  SteadEye-Head—Improving MARG-Sensor Based Head Orientation Measurements Through Eye Tracking Data , 2020, Sensors.

[24]  Wonkeun Youn.  Magnetic Fault–Tolerant Navigation Filter for a UAV , 2020, IEEE Sensors Journal.

[25]  P. Savage.  Strapdown Inertial Navigation Integration Algorithm Design Part 1: Attitude Algorithms , 1998 .

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