Attitude Fusion of Inertial and Magnetic Sensor under Different Magnetic Filed Distortions

By virtue of gravity measurement from a handheld inertial measurement unit (IMU) sensor, current indoor attitude estimation algorithms can provide accurate roll/pitch dimension angles. Acquisition of precise heading is limited by the absence of accurate magnetic reference. Consequently, initial stage magnetometer calibration is deployed to alleviate this bottleneck in attitude fusion. However, available algorithms tackle magnetic distortion based on time-invariant surroundings, casting the post-calibration magnetic data into unchanged ellipsoid centered in the calibration place. Consequently, inaccurate fusion results are formulated in a more common case of random walk in time-varying magnetic indoor environment. This article proposes a new fusion algorithm from various kinds of IMU sensors, namely gyroscope, accelerometer, and magnetometer. Compared to state-of-the-art attitude fusion approaches, this article addresses the indoor time-varying magnetic perturbation problem in a geometric view. We propose an extend Kalman filter--based algorithm based on this detailed geometric model to eliminate the position-dependent effect of a compass sensor. Experimental data demonstrate that, under different indoor magnetic distortion environments, our proposed attitude fusion algorithm has the maximum angle error of 2.02°, outperforming 7.17° of a gradient-declining-based algorithm. Additionally, this attitude fusion result is constructed in a low-cost handheld arduino core--based IMU device, which can be widely applied to embedded systems.

[1]  Wang Yongji,et al.  Research on magnetic compass calibration for air-ground amphibious robot system , 2016, 2016 35th Chinese Control Conference (CCC).

[2]  Fernando García,et al.  Driver Monitoring Based on Low-Cost 3-D Sensors , 2014, IEEE Transactions on Intelligent Transportation Systems.

[3]  Injong Rhee,et al.  Towards Mobile Phone Localization without War-Driving , 2010, 2010 Proceedings IEEE INFOCOM.

[4]  Demoz Gebre-Egziabher,et al.  A Non-linear , Two-step Estimation Algorithm for Calibrating Solid-state Strapdown Magnetometers , 2001 .

[5]  Shuai Li,et al.  Ard-mu-Copter: A Simple Open Source Quadcopter Platform , 2015, 2015 11th International Conference on Mobile Ad-hoc and Sensor Networks (MSN).

[6]  Joseph J. LaViola,et al.  On Kalman Filtering With Nonlinear Equality Constraints , 2007, IEEE Transactions on Signal Processing.

[7]  Gabriel A. Terejanu,et al.  Extended Kalman Filter Tutorial , 2009 .

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

[9]  Venkata N. Padmanabhan,et al.  Indoor localization without the pain , 2010, MobiCom.

[10]  Feng Zhao,et al.  A reliable and accurate indoor localization method using phone inertial sensors , 2012, UbiComp.

[11]  Majid Sarrafzadeh,et al.  HERMES: Mobile system for instability analysis and balance assessment , 2013, TECS.

[12]  Estefania Munoz Diaz,et al.  Standalone inertial pocket navigation system , 2014, 2014 IEEE/ION Position, Location and Navigation Symposium - PLANS 2014.

[13]  Luca Benini,et al.  Design and validation of an attitude and heading reference system for an aerial robot prototype , 2012, 2012 American Control Conference (ACC).

[14]  Anshul Rai,et al.  Zee: zero-effort crowdsourcing for indoor localization , 2012, Mobicom '12.

[15]  Fernando Seco Granja,et al.  Simulation of foot-mounted IMU signals for the evaluation of PDR algorithms , 2011, 2011 International Conference on Indoor Positioning and Indoor Navigation.

[16]  Valérie Renaudin,et al.  Use of Earth’s Magnetic Field for Mitigating Gyroscope Errors Regardless of Magnetic Perturbation , 2011, Sensors.

[17]  Marco Caccamo,et al.  A low-power architecture for high frequency sensor acquisition in many-DOF UAVs , 2014, 2014 ACM/IEEE International Conference on Cyber-Physical Systems (ICCPS).

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

[19]  D. Eberly Least Squares Fitting of Data , 2016 .

[20]  Estefania Munoz Diaz,et al.  Step detector and step length estimator for an inertial pocket navigation system , 2014, 2014 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

[21]  Carlos Silvestre,et al.  Geometric Approach to Strapdown Magnetometer Calibration in Sensor Frame , 2011, IEEE Transactions on Aerospace and Electronic Systems.

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

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

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

[25]  Stephen M. Watt,et al.  The singular value decomposition for polynomial systems , 1995, ISSAC '95.

[26]  Valérie Renaudin,et al.  Correction: Renaudin, V. et al. Use of Earth's Magnetic Field for Mitigating Gyroscope Errors Regardless of Magnetic Perturbation. Sensors 2011, 11, 11390-11414 , 2012, Sensors.

[27]  R. Alonso,et al.  Pedestrian tracking using inertial sensors , 2009 .

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

[29]  Ig-Jae Kim,et al.  Indoor location sensing using geo-magnetism , 2011, MobiSys '11.

[30]  Mauro Marinoni,et al.  Tracking limbs motion using a wireless network of inertial measurement units , 2014, Proceedings of the 9th IEEE International Symposium on Industrial Embedded Systems (SIES 2014).

[31]  M. Uradzinski,et al.  Indoor positioning based on foot-mounted IMU , 2015 .

[32]  G. Lachapelle,et al.  Assessment of Indoor Magnetic Field Anomalies using Multiple Magnetometers , 2010 .

[33]  B. Merminod,et al.  Optimal data fusion for pedestrian navigation based on UWB and MEMS , 2008, 2008 IEEE/ION Position, Location and Navigation Symposium.

[34]  Hiroyuki Yokoyama,et al.  Design and Implementation of Pedestrian Dead Reckoning System on a Mobile Phone , 2011, IEICE Trans. Inf. Syst..

[35]  Patrick Robertson,et al.  Simultaneous localization and mapping for pedestrians using only foot-mounted inertial sensors , 2009, UbiComp.

[36]  Carlos Silvestre,et al.  Low-cost Attitude and Heading Reference System: Filter design and experimental evaluation , 2010, 2010 IEEE International Conference on Robotics and Automation.