MARG Attitude Estimation Using Gradient-Descent Linear Kalman Filter

The magnetic, angular rate, and gravity (MARG) sensor array has been widely used for attitude estimation tasks. In this article, we report our new advances on related fusion algorithm based on the gradient-descent algorithm (GDA). Combining with complementary filters, GDA has been very popular for attitude estimation in industrial applications. The integration of the Kalman filter introduces covariance information and significantly improves in-run quality control. Some useful results are derived to build up the framework of a novel linear Kalman filter called GDA-LKF. A new simplified linear measurement quaternion model is proposed. This article also deals with the analytical adaptive problem of determining gradient-descent step length. We, for the first time, give the solution in the sense of least square based on aided vector measurements. Simulations are carried out to validate the noise sensitivity and covariance characteristics. The proposed schemes are also evaluated by real-world experiments that provide the audience with comparisons on accuracy, convergence, and execution time consumption performances between the proposed GDA-LKFs and recent representative methods. The results show that the proposed GDA-LKF can accurately estimate attitude with fast convergence and high accuracy. Note to Practitioners—Attitude estimation using magnetic, angular rate, and gravity (MARG) sensors is very common for ground, air, and underwater vehicles. The novel findings in this article aim to give the engineers a brand new perspective on the related filter design according to the widely employed gradient-descent algorithm (GDA) method. Some specific techniques, e.g., optimal adaptive law of the designed scheme, will also bring flexibility to the implementation with multiple considerations of object motions.

[1]  Zhi-Qiang Zhang,et al.  Two-Step Calibration Methods for Miniature Inertial and Magnetic Sensor Units , 2015, IEEE Transactions on Industrial Electronics.

[2]  Sebastian Madgwick,et al.  Estimation of IMU and MARG orientation using a gradient descent algorithm , 2011, 2011 IEEE International Conference on Rehabilitation Robotics.

[3]  Yong Li,et al.  Equality Constrained Robust Measurement Fusion for Adaptive Kalman-Filter-Based Heterogeneous Multi-Sensor Navigation , 2013, IEEE Transactions on Aerospace and Electronic Systems.

[4]  Yong Li,et al.  Integrated Navigation System for a Low-Cost Quadrotor Aerial Vehicle in the Presence of Rotor Influences , 2017 .

[5]  Panos Marantos,et al.  UAV State Estimation Using Adaptive Complementary Filters , 2016, IEEE Transactions on Control Systems Technology.

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

[7]  I. Bar-Itzhack,et al.  Novel quaternion Kalman filter , 2002, IEEE Transactions on Aerospace and Electronic Systems.

[8]  Ya Tian,et al.  An Adaptive-Gain Complementary Filter for Real-Time Human Motion Tracking With MARG Sensors in Free-Living Environments , 2013, IEEE Transactions on Neural Systems and Rehabilitation Engineering.

[9]  Jinling Wang,et al.  Effective Adaptive Kalman Filter for MEMS-IMU/Magnetometers Integrated Attitude and Heading Reference Systems , 2012, Journal of Navigation.

[10]  Hassen Fourati,et al.  Heterogeneous Data Fusion Algorithm for Pedestrian Navigation via Foot-Mounted Inertial Measurement Unit and Complementary Filter , 2015, IEEE Transactions on Instrumentation and Measurement.

[11]  F. Markley,et al.  Attitude Estimation Using Modified Rodrigues Parameters , 1996 .

[12]  Xiaoxu Wang,et al.  Gaussian filter for nonlinear systems with correlated noises at the same epoch , 2015, Autom..

[13]  Jin Wu,et al.  Real-Time Magnetometer Disturbance Estimation via Online Nonlinear Programming , 2018, IEEE Sensors Journal.

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

[15]  Young Soo Suh Orientation Estimation Using a Quaternion-Based Indirect Kalman Filter With Adaptive Estimation of External Acceleration , 2010, IEEE Transactions on Instrumentation and Measurement.

[16]  James L. Farrell Performance of strapdown inertial attitude reference systems. , 1966 .

[17]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

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

[19]  A. Makni,et al.  Energy-Aware Adaptive Attitude Estimation Under External Acceleration for Pedestrian Navigation , 2016, IEEE/ASME Transactions on Mechatronics.

[20]  Rui Li,et al.  Analytic accelerometer–magnetometer attitude determination without reference information , 2018 .

[21]  Zebo Zhou Optimal Batch Distributed Asynchronous Multisensor Fusion With Feedback , 2019, IEEE Transactions on Aerospace and Electronic Systems.

[22]  Fangjun Qin,et al.  Indirect Kalman Filtering Based Attitude Estimation for Low-Cost Attitude and Heading Reference Systems , 2017, IEEE/ASME Transactions on Mechatronics.

[23]  Yuxiang Sun,et al.  Hand-Eye Calibration: 4-D Procrustes Analysis Approach , 2020, IEEE Transactions on Instrumentation and Measurement.

[24]  Tianhe Xu,et al.  M-estimator for the 3D symmetric Helmert coordinate transformation , 2017, Journal of Geodesy.

[25]  Xiaodong Wang,et al.  Kalman-Filtering-Based In-Motion Coarse Alignment for Odometer-Aided SINS , 2017, IEEE Transactions on Instrumentation and Measurement.

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

[27]  G. Wahba A Least Squares Estimate of Satellite Attitude , 1965 .

[28]  Yaguang Yang,et al.  An analytic solution to Wahbaʼs problem , 2013 .

[29]  Yaguang Yang,et al.  Spacecraft attitude determination and control: Quaternion based method , 2012, Annu. Rev. Control..

[30]  Yonggang Zhang,et al.  Robust student’s t based nonlinear filter and smoother , 2016, IEEE Transactions on Aerospace and Electronic Systems.

[31]  Noureddine Manamanni,et al.  Posture and body acceleration tracking by inertial and magnetic sensing: Application in behavioral analysis of free-ranging animals , 2011, Biomed. Signal Process. Control..

[32]  Zhipei Huang,et al.  Adaptive Information Fusion for Human Upper Limb Movement Estimation , 2012, IEEE Transactions on Systems, Man, and Cybernetics - Part A: Systems and Humans.

[33]  Jizhong Xiao,et al.  A Linear Kalman Filter for MARG Orientation Estimation Using the Algebraic Quaternion Algorithm , 2016, IEEE Transactions on Instrumentation and Measurement.

[34]  J. Bortz A New Mathematical Formulation for Strapdown Inertial Navigation , 1971, IEEE Transactions on Aerospace and Electronic Systems.

[35]  Mohamed Khalgui,et al.  Micro Air Vehicle Link (MAVlink) in a Nutshell: A Survey , 2019, IEEE Access.

[36]  Wenqi Wu,et al.  High-order attitude compensation in coning and rotation coexisting environment , 2015, IEEE Transactions on Aerospace and Electronic Systems.

[37]  Yuichi Motai,et al.  Head Orientation Prediction: Delta Quaternions Versus Quaternions , 2009, IEEE Transactions on Systems, Man, and Cybernetics, Part B (Cybernetics).

[38]  M. Pittelkau Rotation Vector in Attitude Estimation , 2003 .

[39]  Jiancheng Fang,et al.  Integrated Model and Compensation of Thermal Errors of Silicon Microelectromechanical Gyroscope , 2009, IEEE Transactions on Instrumentation and Measurement.

[40]  Rui Li,et al.  Fast Linear Quaternion Attitude Estimator Using Vector Observations , 2018, IEEE Transactions on Automation Science and Engineering.

[41]  Hassen Fourati,et al.  Fast Complementary Filter for Attitude Estimation Using Low-Cost MARG Sensors , 2016, IEEE Sensors Journal.

[42]  Ya Tian,et al.  Accurate Human Navigation Using Wearable Monocular Visual and Inertial Sensors , 2014, IEEE Transactions on Instrumentation and Measurement.

[43]  Zhi-Qiang Zhang Cameras and Inertial/Magnetic Sensor Units Alignment Calibration , 2016, IEEE Transactions on Instrumentation and Measurement.

[44]  Lawrence Wai-Choong Wong,et al.  Ubiquitous Human Upper-Limb Motion Estimation using Wearable Sensors , 2011, IEEE Transactions on Information Technology in Biomedicine.

[45]  Hassen Fourati,et al.  Generalized Linear Quaternion Complementary Filter for Attitude Estimation From Multisensor Observations: An Optimization Approach , 2019, IEEE Transactions on Automation Science and Engineering.

[46]  Noureddine Manamanni,et al.  Complementary Observer for Body Segments Motion Capturing by Inertial and Magnetic Sensors , 2014, IEEE/ASME Transactions on Mechatronics.

[47]  Robert B. McGhee,et al.  Design, Implementation, and Experimental Results of a Quaternion-Based Kalman Filter for Human Body Motion Tracking , 2005, IEEE Transactions on Robotics.

[48]  Mehrzad Namvar,et al.  Adaptive Compensation of Gyro Bias in Rigid-Body Attitude Estimation Using a Single Vector Measurement , 2013, IEEE Transactions on Automatic Control.

[49]  Hassen Fourati,et al.  A Super Fast Attitude Determination Algorithm for Consumer-Level Accelerometer and Magnetometer , 2018, IEEE Transactions on Consumer Electronics.

[50]  Chai Kiat Yeo,et al.  Smartphone Orientation Estimation Algorithm Combining Kalman Filter With Gradient Descent , 2018, IEEE Journal of Biomedical and Health Informatics.

[51]  Peng Shi,et al.  Robust Kalman Filters Based on Gaussian Scale Mixture Distributions With Application to Target Tracking , 2019, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[52]  Yaguang Yang Controllability of spacecraft using only magnetic torques , 2016, IEEE Transactions on Aerospace and Electronic Systems.

[53]  Yuanxin Wu,et al.  Calibration of three-axis strapdown magnetometers using Particle Swarm Optimization algorithm , 2011, 2011 IEEE International Symposium on Robotic and Sensors Environments (ROSE).

[54]  John L. Crassidis,et al.  Fundamentals of Spacecraft Attitude Determination and Control , 2014 .

[55]  Biao Huang,et al.  Control Design for Disturbance Rejection in the Presence of Uncertain Delays , 2017, IEEE Transactions on Automation Science and Engineering.

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