Delay Kalman Filter to Estimate the Attitude of a Mobile Object with Indoor Magnetic Field Gradients

More and more services are based on knowing the location of pedestrians equipped with connected objects (smartphones, smartwatches, etc.). One part of the location estimation process is attitude estimation. Many algorithms have been proposed but they principally target open space areas where the local magnetic field equals the Earth’s field. Unfortunately, this approach is impossible indoors, where the use of magnetometer arrays or magnetic field gradients has been proposed. However, current approaches omit the impact of past state estimates on the current orientation estimate, especially when a reference field is computed over a sliding window. A novel Delay Kalman filter is proposed in this paper to integrate this time correlation: the Delay MAGYQ. Experimental assessment, conducted in a motion lab with a handheld inertial and magnetic mobile unit, shows that the novel filter better estimates the Euler angles of the handheld device with an 11.7° mean error on the yaw angle as compared to 16.4° with a common Additive Extended Kalman filter.

[1]  David Vissière,et al.  Guidance navigation and control solutions for unmanned heterogeneous vehicles during a collaborative mission , 2008 .

[2]  Xiao Lu,et al.  Kalman filtering for multiple time-delay systems , 2005, Autom..

[3]  I. Bar-Itzhack,et al.  Attitude Determination from Vector Observations: Quaternion Estimation , 1985, IEEE Transactions on Aerospace and Electronic Systems.

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

[5]  Valérie Renaudin,et al.  Magnetic perturbations detection and heading estimation using magnetometers , 2012, J. Locat. Based Serv..

[6]  Stergios I. Roumeliotis,et al.  Stochastic cloning: a generalized framework for processing relative state measurements , 2002, Proceedings 2002 IEEE International Conference on Robotics and Automation (Cat. No.02CH37292).

[7]  Valérie Renaudin,et al.  Motion Mode Recognition and Step Detection Algorithms for Mobile Phone Users , 2013, Sensors.

[8]  H. Kwakernaak,et al.  Optimal filtering in linear systems with time delays , 1967, IEEE Transactions on Automatic Control.

[9]  Z. Berman,et al.  Inertial sensors: Further developments in low-cost calibration and testing , 2012, Proceedings of the 2012 IEEE/ION Position, Location and Navigation Symposium.

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

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

[12]  Robert E. Mahony,et al.  Attitude estimation on SO[3] based on direct inertial measurements , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[13]  Janne Haverinen,et al.  Global indoor self-localization based on the ambient magnetic field , 2009, Robotics Auton. Syst..

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

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

[16]  Valérie Renaudin,et al.  Complete Triaxis Magnetometer Calibration in the Magnetic Domain , 2010, J. Sensors.