Orientation Estimation by Partial-State Updating Kalman Filter and Vectorial Magnetic Interference Detection

Attitude estimation based on a magnetic and inertial measurement unit is popular in the areas of robotics, aerospace, and unmanned aerial vehicles. Nevertheless, the magnetometer is prone to external magnetic disturbance that deteriorates the state estimation. This article proposes a novel partial state update strategy in the extended Kalman filter (PS-EKF) by optimally solving the posteriori covariance optimization problem under the Kalman gain constraint, so as to obviate the magnetic measurement update on two level angles and the inertial sensor biases. Besides, a new magnetic disturbance detection technique (vectorial detector) considering both the norm and the direction of the magnetometer measurement is proposed. Simulations and experiments show that the proposed PS-EKF method can be totally immune to the magnetic interference on the level angles and sensors biases, in contrast to the traditional extended Kalman filter using either the direct magnetic output or the indirect yaw as the measurement.

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

[2]  Xin Tong,et al.  A Double-Step Unscented Kalman Filter and HMM-Based Zero-Velocity Update for Pedestrian Dead Reckoning Using MEMS Sensors , 2020, IEEE Transactions on Industrial Electronics.

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

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

[5]  Jung-Keun Lee,et al.  Minimum-Order Kalman Filter With Vector Selector for Accurate Estimation of Human Body Orientation , 2009, IEEE Transactions on Robotics.

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

[7]  Manuela Herman,et al.  Aided Navigation Gps With High Rate Sensors , 2016 .

[8]  Fernando Seco Granja,et al.  Indoor pedestrian navigation using an INS/EKF framework for yaw drift reduction and a foot-mounted IMU , 2010, 2010 7th Workshop on Positioning, Navigation and Communication.

[9]  Yuanxin Wu,et al.  On Misalignment Between Magnetometer and Inertial Sensors , 2016, IEEE Sensors Journal.

[10]  Puneet Singla,et al.  Robust Attitude Estimation from Uncertain Observations of Inertial Sensors Using Covariance Inflated Multiplicative Extended Kalman Filter , 2018, IEEE Transactions on Instrumentation and Measurement.

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

[12]  Jungmin Park,et al.  Adaptive Attitude Estimation for Low-Cost MEMS IMU Using Ellipsoidal Method , 2020, IEEE Transactions on Instrumentation and Measurement.

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

[14]  Yulong Huang,et al.  Adaptive Robust Nonlinear Filtering for Spacecraft Attitude Estimation Based on Additive Quaternion , 2020, IEEE Transactions on Instrumentation and Measurement.

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

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

[17]  Yoshikatsu Hayashi,et al.  Formulation of a new gradient descent MARG orientation algorithm: Case study on robot teleoperation , 2019, Mechanical Systems and Signal Processing.

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

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

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

[22]  Yuanxin Wu,et al.  Dynamic Magnetometer Calibration and Alignment to Inertial Sensors by Kalman Filtering , 2016, IEEE Transactions on Control Systems Technology.

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

[24]  Xiaoli Meng,et al.  Quaternion-Based Kalman Filter With Vector Selection for Accurate Orientation Tracking , 2012, IEEE Transactions on Instrumentation and Measurement.

[25]  Robert B. McGhee,et al.  An extended Kalman filter for quaternion-based orientation estimation using MARG sensors , 2001, Proceedings 2001 IEEE/RSJ International Conference on Intelligent Robots and Systems. Expanding the Societal Role of Robotics in the the Next Millennium (Cat. No.01CH37180).

[26]  Robert Grover Brown,et al.  Introduction to random signals and applied Kalman filtering : with MATLAB exercises and solutions , 1996 .

[27]  Xiaoping Yun,et al.  Design, Implementation, and Experimental Results of a Quaternion-Based Kalman Filter for Human Body Motion Tracking , 2006, IEEE Trans. Robotics.

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

[29]  Wen-An Zhang,et al.  A Novel Adaptive Kalman Filtering Approach to Human Motion Tracking With Magnetic-Inertial Sensors , 2020, IEEE Transactions on Industrial Electronics.

[30]  George Vukovich,et al.  Robust Adaptive Tracking of Rigid-Body Motion With Applications to Asteroid Proximity Operations , 2017, IEEE Transactions on Aerospace and Electronic Systems.

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

[32]  Hee-Jun Kang,et al.  Quaternion-Based Indirect Kalman Filter Discarding Pitch and Roll Information Contained in Magnetic Sensors , 2012, IEEE Transactions on Instrumentation and Measurement.

[33]  Eric Foxlin,et al.  Pedestrian tracking with shoe-mounted inertial sensors , 2005, IEEE Computer Graphics and Applications.

[34]  Xiaoping Yun,et al.  Adaptive-gain complementary filter of inertial and magnetic data for orientation estimation , 2011, 2011 IEEE International Conference on Robotics and Automation.

[35]  Carlos Silvestre,et al.  Discrete-Time Complementary Filters for Attitude and Position Estimation: Design, Analysis and Experimental Validation , 2011, IEEE Transactions on Control Systems Technology.

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

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

[38]  P. Groves.  Principles of GNSS, Inertial, and Multi-Sensor Integrated Navigation Systems , 2007 .

[39]  D K Smith,et al.  Numerical Optimization , 2001, J. Oper. Res. Soc..

[40]  Susanna Kaiser,et al.  A Review of Indoor Localization Methods Based on Inertial Sensors , 2019, Geographical and Fingerprinting Data to Create Systems for Indoor Positioning and Indoor/Outdoor Navigation.

[41]  Xiaoming Hu,et al.  Drift-free attitude estimation for accelerated rigid bodies , 2004, Autom..

[42]  Xiaoming Hu,et al.  Drift-free attitude estimation for accelerated rigid bodies , 2001, Proceedings 2001 ICRA. IEEE International Conference on Robotics and Automation (Cat. No.01CH37164).

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