Research on an Improved Method for Foot-Mounted Inertial/Magnetometer Pedestrian-Positioning Based on the Adaptive Gradient Descent Algorithm

Foot-mounted Inertial Pedestrian-Positioning Systems (FIPPSs) based on Micro Inertial Measurement Units (MIMUs), have recently attracted widespread attention with the rapid development of MIMUs. The can be used in challenging environments such as firefighting and the military, even without augmenting with Global Navigation Satellite System (GNSS). Zero Velocity Update (ZUPT) provides a solution for the accumulated positioning errors produced by the low precision and high noise of the MIMU, however, there are some problems using ZUPT for FIPPS, include fast-initial alignment and unobserved heading misalignment angle, which are addressed in this paper. Our first contribution is proposing a fast-initial alignment algorithm for foot-mounted inertial/magnetometer pedestrian positioning based on the Adaptive Gradient Descent Algorithm (AGDA). Considering the characteristics of gravity and Earth’s magnetic field, measured by accelerometers and magnetometers, respectively, when the pedestrian is standing at one place, the AGDA is introduced as the fast-initial alignment. The AGDA is able to estimate the initial attitude and enhance the ability of magnetic disturbance suppression. Our second contribution in this paper is proposing an inertial/magnetometer positioning algorithm based on an adaptive Kalman filter to solve the problem of the unobserved heading misalignment angle. The algorithm utilizes heading misalignment angle as an observation for the Kalman filter and can improve the accuracy of pedestrian position by compensating for magnetic disturbances. In addition, introducing an adaptive parameter in the Kalman filter is able to compensate the varying magnetic disturbance for each ZUPT instant during the walking phase of the pedestrian. The performance of the proposed method is examined by conducting pedestrian test trajectory using MTi-G710 manufacture by XSENS. The experimental results verify the effectiveness and applicability of the proposed method.

[1]  Jiang Cheng Fang,et al.  A fast initial alignment method for strapdown inertial navigation system on stationary base , 1996 .

[2]  Isaac Skog,et al.  Fusing the information from two navigation systems using an upper bound on their maximum spatial separation , 2012, 2012 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

[3]  James Cutler,et al.  Attitude-Independent Magnetometer Calibration with Time-Varying Bias , 2012 .

[4]  Tao Zhang,et al.  A Kalman Filter for SINS Self-Alignment Based on Vector Observation , 2017, Sensors.

[5]  Carl Fischer,et al.  Tutorial: Implementing a Pedestrian Tracker Using Inertial Sensors , 2013, IEEE Pervasive Computing.

[6]  Sebastian O. H. Madgwick,et al.  An efficient orientation filter for inertial and inertial / magnetic sensor arrays , 2010 .

[7]  Chan Gook Park,et al.  Enhanced Pedestrian Navigation Based on Course Angle Error Estimation Using Cascaded Kalman Filters , 2018, Sensors.

[8]  K. V. S. Hari,et al.  Foot-mounted INS for everybody - an open-source embedded implementation , 2012, Proceedings of the 2012 IEEE/ION Position, Location and Navigation Symposium.

[9]  Lubin Chang,et al.  Initial Alignment by Attitude Estimation for Strapdown Inertial Navigation Systems , 2015, IEEE Transactions on Instrumentation and Measurement.

[10]  Zhihui Lin,et al.  Self-Alignment MEMS IMU Method Based on the Rotation Modulation Technique on a Swing Base , 2018, Sensors.

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

[12]  M. Shuster,et al.  Complete linear attitude-independent magnetometer calibration , 2002 .

[13]  S. Godha,et al.  Foot mounted inertial system for pedestrian navigation , 2008 .

[14]  Xie Ling,et al.  Applications of zero-velocity detector and Kalman filter in zero velocity update for inertial navigation system , 2014, Proceedings of 2014 IEEE Chinese Guidance, Navigation and Control Conference.

[15]  Audrey Giremus,et al.  Calibration of an inertial-magnetic measurement unit without external equipment, in the presence of dynamic magnetic disturbances , 2014 .

[16]  Zhang Xiao-dong,et al.  A new zero velocity update algorithm for the shoe-mounted personal navigation system based on IMU , 2015, 2015 34th Chinese Control Conference (CCC).

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

[18]  Malcolm D. Shuster,et al.  TWOSTEP: A fast robust algorithm for attitude-independent magnetometer-bias determination , 2002 .

[19]  Xiaoji Niu,et al.  Fast Thermal Calibration of Low-Grade Inertial Sensors and Inertial Measurement Units , 2013, Sensors.

[20]  Isaac Skog,et al.  Evaluation of zero-velocity detectors for foot-mounted inertial navigation systems , 2010, 2010 International Conference on Indoor Positioning and Indoor Navigation.

[21]  Yuanxin Wu,et al.  On Calibration of Three-Axis Magnetometer , 2015, IEEE Sensors Journal.

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

[23]  Zheng Guo,et al.  Research on the Forward and Reverse Calculation Based on the Adaptive Zero-Velocity Interval Adjustment for the Foot-Mounted Inertial Pedestrian-Positioning System , 2018, Sensors.

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

[25]  Andrew G. Dempster,et al.  Attitude determination by integration of MEMS inertial sensors and GPS for autonomous agriculture applications , 2011, GPS Solutions.

[26]  Bertrand Grandvallet,et al.  Real-Time Attitude-Independent Three-Axis Magnetometer Calibration for Spinning Projectiles: A Sliding Window Approach , 2014, IEEE Transactions on Control Systems Technology.

[27]  Jay A. Farrell,et al.  Observability analysis of an inertial navigation system with stationary updates , 2011, Proceedings of the 2011 American Control Conference.

[28]  Wei Gao,et al.  Improved filter estimation method applied in zero velocity update for SINS , 2009, 2009 International Conference on Mechatronics and Automation.

[29]  Jeroen D. Hol,et al.  Sensor Fusion and Calibration of Inertial Sensors, Vision, Ultra-Wideband and GPS , 2011 .

[30]  Tao Xu,et al.  Research on Rotating Modulated Strap-Down Inertial Navigation System Based on Micro-Electro-Mechanical Systems (MEMS) Sensors (RMSINS) , 2011 .

[31]  Naser El-Sheimy,et al.  Map-Based Indoor Pedestrian Navigation Using an Auxiliary Particle Filter , 2017, Micromachines.

[32]  Fabio Leccese,et al.  Lightweight GNSS/IRS integrated navigation system for UAV vehicles , 2014, 2014 IEEE Metrology for Aerospace (MetroAeroSpace).

[33]  Isaac Skog,et al.  Zero-Velocity Detection—An Algorithm Evaluation , 2010, IEEE Transactions on Biomedical Engineering.

[34]  Thomas B. Schön,et al.  Magnetometer Calibration Using Inertial Sensors , 2016, IEEE Sensors Journal.

[35]  Tao Xu,et al.  Analysis and Verification of Rotation Modulation Effects on Inertial Navigation System based on MEMS Sensors , 2013, Journal of Navigation.

[36]  Ali Mohammadi,et al.  INS Alignment Improvement Using Rest Heading and Zero-Velocity Updates , 2016 .

[37]  John M. Elwell,et al.  Inertial navigation for the urban warrior , 1999, Defense, Security, and Sensing.

[38]  J. Borenstein,et al.  Non-GPS Navigation for Security Personnel and First Responders , 2007, Journal of Navigation.

[39]  Hai Yang,et al.  Adaptive Zero Velocity Update Based on Velocity Classification for Pedestrian Tracking , 2017, IEEE Sensors Journal.

[40]  Ozkan Bebek,et al.  Personal Navigation via High-Resolution Gait-Corrected Inertial Measurement Units , 2010, IEEE Transactions on Instrumentation and Measurement.

[41]  Isaac Skog,et al.  Cooperative localization by dual foot-mounted inertial sensors and inter-agent ranging , 2013, EURASIP J. Adv. Signal Process..

[42]  Zhelong Wang,et al.  Smooth estimation of human foot motion for zero-velocity-update-aided inertial pedestrian navigation system , 2015 .

[43]  John L. Crassidis,et al.  Real-Time Attitude-Independent Three-Axis Magnetometer Calibration , 2005 .

[44]  Hai Yang,et al.  Research on the Strategy of Motion Constraint-Aided ZUPT for the SINS Positioning System of a Shearer , 2017, Micromachines.