Sensor fusion algorithms for orientation tracking via magnetic and inertial measurement units: An experimental comparison survey

Abstract Lightweight and low-cost wearable magnetic and inertial measurement units (MIMUs) have found numerous applications, such as aerial vehicle navigation or human motion analysis, where the 3D orientation tracking of a rigid body is of interest. However, due to the errors in measurements of gyroscope, accelerometer, and/or magnetometer inside a MIMU, numerous studies have proposed sensor fusion algorithms (SFAs) to estimate the 3D orientation accurately and robustly. This paper contributes to these efforts by performing an experimental comparison among a variety of SFAs. Notably, we compared the estimated orientation of 36 SFAs from the complementary filter and linear/extended/complementary/unscented/cubature Kalman filter families with the reference orientation obtained from a camera motion-capture system. The experimental study included data collection with a foot-worn MIMU where nine participants performed various short- and long-duration tasks. We shared the codes and sample of data in https://www.ncbl.ualberta.ca/codes to enable other researchers to compare their works with the literature toward creating a comprehensive online repository for SFAs. To perform a fair comparison, we used the Particle Swarm Optimization routine to find the optimal adaptive gain tuning scheme for each SFAs, as recommended in the literature. Our experimental results showed that gyroscope static bias removal, in general, showed to be effective in reducing the estimation error of SFAs, specifically during long-duration trials. Moreover, our experimental results identified the SFAs with the highest accuracy from each family. We also reported the execution times for the selected SFAs from each family. This paper is among the first experimental comparison studies which provide such breadth of coverage across various SFAs for tracking orientation with MIMUs.

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

[2]  F. V. D. van der Helm,et al.  Magnetic distortion in motion labs, implications for validating inertial magnetic sensors. , 2009, Gait & posture.

[3]  Robert E. Mahony,et al.  Implementation of a Nonlinear Attitude Estimator for Aerial Robotic Vehicles , 2014, IEEE Transactions on Control Systems Technology.

[4]  Hossein Rouhani,et al.  Semi-Automatic Sensor-to-Body Calibration of Inertial Sensors on Lower Limb Using Gait Recording , 2019, IEEE Sensors Journal.

[5]  Arto Visala,et al.  A DCM Based Attitude Estimation Algorithm for Low-Cost MEMS IMUs , 2015 .

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

[7]  Henrique Marra Menegaz,et al.  A Systematization of the Unscented Kalman Filter Theory , 2015, IEEE Transactions on Automatic Control.

[8]  Angelo M. Sabatini,et al.  Dealing with Magnetic Disturbances in Human Motion Capture: A Survey of Techniques , 2016, Micromachines.

[9]  Marco Parvis,et al.  Procedure for effortless in-field calibration of three-axial rate gyro and accelerometers , 1995 .

[10]  Angelo M. Sabatini,et al.  Assessing the Performance of Sensor Fusion Methods: Application to Magnetic-Inertial-Based Human Body Tracking , 2016, Sensors.

[11]  Raja Ariffin Raja Ghazilla,et al.  Reviews on Various Inertial Measurement Unit (IMU) Sensor Applications , 2013, SiPS 2013.

[12]  Howard Chen,et al.  Measuring upper arm elevation using an inertial measurement unit: An exploration of sensor fusion algorithms and gyroscope models. , 2020, Applied ergonomics.

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

[14]  Hassen Fourati,et al.  A comparative analysis of attitude estimation for pedestrian navigation with smartphones , 2015, 2015 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

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

[16]  Heng Zhang,et al.  An Efficient Method for Tri-Axis Magnetometer Calibration , 2019, 2019 IEEE SmartWorld, Ubiquitous Intelligence & Computing, Advanced & Trusted Computing, Scalable Computing & Communications, Cloud & Big Data Computing, Internet of People and Smart City Innovation (SmartWorld/SCALCOM/UIC/ATC/CBDCom/IOP/SCI).

[17]  A. Cereatti,et al.  Accuracy of the Orientation Estimate Obtained Using Four Sensor Fusion Filters Applied to Recordings of Magneto-Inertial Sensors Moving at Three Rotation Rates , 2019, 2019 41st Annual International Conference of the IEEE Engineering in Medicine and Biology Society (EMBC).

[18]  Ajith Abraham,et al.  Differential Evolution: A review of more than two decades of research , 2020, Eng. Appl. Artif. Intell..

[19]  Milad Nazarahari,et al.  40 years of sensor fusion for orientation tracking via magnetic and inertial measurement units: Methods, lessons learned, and future challenges , 2021, Inf. Fusion.

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

[21]  J H Challis,et al.  An examination of procedures for determining body segment attitude and position from noisy biomechanical data. , 1995, Medical engineering & physics.

[22]  Angelo M. Sabatini,et al.  A linear Kalman Filtering-based approach for 3D orientation estimation from Magnetic/Inertial sensors , 2015, 2015 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI).

[23]  Caro Lucas,et al.  Imperialist competitive algorithm: An algorithm for optimization inspired by imperialistic competition , 2007, 2007 IEEE Congress on Evolutionary Computation.

[24]  Simon J. Julier,et al.  The spherical simplex unscented transformation , 2003, Proceedings of the 2003 American Control Conference, 2003..

[25]  Hassen Fourati,et al.  On attitude estimation with smartphones , 2017, 2017 IEEE International Conference on Pervasive Computing and Communications (PerCom).

[26]  Reinhold Haux,et al.  Performance comparison of accelerometer calibration algorithms based on 3D-ellipsoid fitting methods , 2013, Comput. Methods Programs Biomed..

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

[28]  Riccardo Poli,et al.  Particle swarm optimization , 1995, Swarm Intelligence.

[29]  D. Simon.  Optimal State Estimation: Kalman, H Infinity, and Nonlinear Approaches , 2006 .

[30]  Václav Šmídl,et al.  Fast AHRS Filter for Accelerometer, Magnetometer, and Gyroscope Combination with Separated Sensor Corrections , 2020, Sensors.

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

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

[33]  Howard Chen,et al.  Effects of Movement Speed and Magnetic Disturbance on the Accuracy of Inertial Measurement Units , 2017 .

[34]  Hossein Rouhani,et al.  Detection of daily postures and walking modalities using a single chest-mounted tri-axial accelerometer. , 2018, Medical engineering & physics.

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

[36]  Senem Velipasalar,et al.  A Survey on Activity Detection and Classification Using Wearable Sensors , 2017, IEEE Sensors Journal.

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

[38]  H.F. Durrant-Whyte,et al.  A new approach for filtering nonlinear systems , 1995, Proceedings of 1995 American Control Conference - ACC'95.

[39]  Xin Li,et al.  Evaluation of AHRS algorithms for Foot-Mounted Inertial-based Indoor Navigation Systems , 2019, Open Geosciences.

[40]  I. Postlethwaite,et al.  Square Root Cubature Information Filter , 2013, IEEE Sensors Journal.

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

[42]  Norbert Schmitz,et al.  Survey of Motion Tracking Methods Based on Inertial Sensors: A Focus on Upper Limb Human Motion , 2017, Sensors.

[43]  Du Q. Huynh,et al.  Metrics for 3D Rotations: Comparison and Analysis , 2009, Journal of Mathematical Imaging and Vision.

[44]  Humberto Sossa,et al.  3D motion tracking of the shoulder joint with respect to the thorax using MARG sensors and data fusion algorithm , 2020 .

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

[46]  Hee-Jun Kang,et al.  A DCM Based Orientation Estimation Algorithm with an Inertial Measurement Unit and a Magnetic Compass , 2009, J. Univers. Comput. Sci..

[47]  Domenico Campolo,et al.  Methodology for the Evaluation of Magneto-Inertial Orientation Filters in SO(3) , 2019, 2019 II Workshop on Metrology for Industry 4.0 and IoT (MetroInd4.0&IoT).

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

[49]  Rudolph van der Merwe,et al.  The square-root unscented Kalman filter for state and parameter-estimation , 2001, 2001 IEEE International Conference on Acoustics, Speech, and Signal Processing. Proceedings (Cat. No.01CH37221).

[50]  J. McCall,et al.  Genetic algorithms for modelling and optimisation , 2005 .

[51]  Milad Nazarahari,et al.  A multi-wavelet optimization approach using similarity measures for electrocardiogram signal classification , 2015, Biomed. Signal Process. Control..

[52]  Hossein Rouhani,et al.  Sensor-to-body calibration procedure for clinical motion analysis of lower limb using magnetic and inertial measurement units. , 2019, Journal of biomechanics.

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

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

[55]  Noureddine Manamanni,et al.  A Nonlinear Filtering Approach for the Attitude and Dynamic Body Acceleration Estimation Based on Inertial and Magnetic Sensors: Bio-Logging Application , 2011, IEEE Sensors Journal.

[56]  Esmaeel Khanmirza,et al.  Multi-objective multi-robot path planning in continuous environment using an enhanced genetic algorithm , 2019, Expert Syst. Appl..

[57]  Behnam Mohammadi-ivatloo,et al.  Application of Particle Swarm Optimization Algorithm in Power System Problems , 2017 .

[58]  Young Soo Suh,et al.  Simple-Structured Quaternion Estimator Separating Inertial and Magnetic Sensor Effects , 2019, IEEE Transactions on Aerospace and Electronic Systems.

[59]  Valérie Renaudin,et al.  Magnetic, Acceleration Fields and Gyroscope Quaternion (MAGYQ)-Based Attitude Estimation with Smartphone Sensors for Indoor Pedestrian Navigation , 2014, Sensors.

[60]  N. Lovell,et al.  Quaternion-Based Complementary Filter for Attitude Determination of a Smartphone , 2016, IEEE Sensors Journal.

[61]  Henrique Marra Menegaz,et al.  A new smallest sigma set for the Unscented Transform and its applications on SLAM , 2011, IEEE Conference on Decision and Control and European Control Conference.

[62]  Hassen Fourati,et al.  Recursive linear continuous quaternion attitude estimator from vector observations , 2018, IET Radar, Sonar & Navigation.

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

[64]  N. Lovell,et al.  Computationally Efficient Adaptive Error-State Kalman Filter for Attitude Estimation , 2018, IEEE Sensors Journal.

[65]  F. Veldpaus,et al.  A least-squares algorithm for the equiform transformation from spatial marker co-ordinates. , 1988, Journal of biomechanics.

[66]  Alexander D. Young.  Comparison of Orientation Filter Algorithms for Realtime Wireless Inertial Posture Tracking , 2009, 2009 Sixth International Workshop on Wearable and Implantable Body Sensor Networks.

[67]  Simone A. Ludwig,et al.  Comparison of Euler Estimate using Extended Kalman Filter, Madgwick and Mahony on Quadcopter Flight Data , 2018, 2018 International Conference on Unmanned Aircraft Systems (ICUAS).

[68]  Angelo M. Sabatini,et al.  Estimating Three-Dimensional Orientation of Human Body Parts by Inertial/Magnetic Sensing , 2011, Sensors.

[69]  Angelo M. Sabatini,et al.  Estimating Orientation Using Magnetic and Inertial Sensors and Different Sensor Fusion Approaches: Accuracy Assessment in Manual and Locomotion Tasks , 2014, Sensors.

[70]  Robert Harle,et al.  A Survey of Indoor Inertial Positioning Systems for Pedestrians , 2013, IEEE Communications Surveys & Tutorials.

[71]  Milad Nazarahari,et al.  Adaptive Gain Regulation of Sensor Fusion Algorithms for Orientation Estimation with Magnetic and Inertial Measurement Units , 2021, IEEE Transactions on Instrumentation and Measurement.

[72]  Jin Wu,et al.  MARG Attitude Estimation Using Gradient-Descent Linear Kalman Filter , 2020, IEEE Transactions on Automation Science and Engineering.

[73]  H. Weiss,et al.  Direction Cosine Matrix Estimation from Vector Observations using a Matrix Kalman Filter , 2010, IEEE Transactions on Aerospace and Electronic Systems.

[74]  S. Haykin,et al.  Cubature Kalman Filters , 2009, IEEE Transactions on Automatic Control.

[75]  Yuanqing Xia,et al.  An adaptive Kalman filter estimating process noise covariance , 2017, Neurocomputing.

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

[77]  P. Veltink,et al.  Compensation of magnetic disturbances improves inertial and magnetic sensing of human body segment orientation , 2005, IEEE Transactions on Neural Systems and Rehabilitation Engineering.

[78]  Neelesh Kumar,et al.  Errors in micro-electro-mechanical systems inertial measurement and a review on present practices of error modelling , 2018, Trans. Inst. Meas. Control.