Enhanced Pedestrian Navigation Based on Course Angle Error Estimation Using Cascaded Kalman Filters

An enhanced pedestrian dead reckoning (PDR) based navigation algorithm, which uses two cascaded Kalman filters (TCKF) for the estimation of course angle and navigation errors, is proposed. The proposed algorithm uses a foot-mounted inertial measurement unit (IMU), waist-mounted magnetic sensors, and a zero velocity update (ZUPT) based inertial navigation technique with TCKF. The first stage filter estimates the course angle error of a human, which is closely related to the heading error of the IMU. In order to obtain the course measurements, the filter uses magnetic sensors and a position-trace based course angle. For preventing magnetic disturbance from contaminating the estimation, the magnetic sensors are attached to the waistband. Because the course angle error is mainly due to the heading error of the IMU, and the characteristic error of the heading angle is highly dependent on that of the course angle, the estimated course angle error is used as a measurement for estimating the heading error in the second stage filter. At the second stage, an inertial navigation system-extended Kalman filter-ZUPT (INS-EKF-ZUPT) method is adopted. As the heading error is estimated directly by using course-angle error measurements, the estimation accuracy for the heading and yaw gyro bias can be enhanced, compared with the ZUPT-only case, which eventually enhances the position accuracy more efficiently. The performance enhancements are verified via experiments, and the way-point position error for the proposed method is compared with those for the ZUPT-only case and with other cases that use ZUPT and various types of magnetic heading measurements. The results show that the position errors are reduced by a maximum of 90% compared with the conventional ZUPT based PDR algorithms.

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

[2]  Piotr Ptasinski,et al.  A method for dead reckoning parameter correction in pedestrian navigation system , 2003, IEEE Trans. Instrum. Meas..

[3]  Manfred Wieser,et al.  Navigation: Principles of Positioning and Guidance , 2003 .

[4]  William C. Suski,et al.  Using a Map of Measurement Noise to Improve UWB Indoor Position Tracking , 2013, IEEE Transactions on Instrumentation and Measurement.

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

[6]  I-Ming Chen,et al.  SLAC: 3D localization of human based on kinetic human movement capture , 2011, 2011 IEEE International Conference on Robotics and Automation.

[7]  John Weston,et al.  Strapdown Inertial Navigation Technology , 1997 .

[8]  Chan Gook Park,et al.  INS/GPS Integrated Smoothing Algorithm for Synthetic Aperture Radar Motion Compensation Using an Extended Kalman Filter with a Position Damping Loop , 2017 .

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

[10]  Jiann-Liang Chen,et al.  Novel fingerprinting mechanisms for indoor positioning , 2016, Int. J. Commun. Syst..

[11]  Xiaoji Niu,et al.  Improving the Design of MEMS INS-Aided PLLs for GNSS Carrier Phase Measurement under High Dynamics , 2017, Micromachines.

[12]  Mark Latt,et al.  Reliability of the GAITRite walkway system for the quantification of temporo-spatial parameters of gait in young and older people. , 2004, Gait & posture.

[13]  Chan Gook Park,et al.  Kinematic Model-Based Pedestrian Dead Reckoning for Heading Correction and Lower Body Motion Tracking , 2015, Sensors.

[14]  Priyanka Aggarwal,et al.  Map Matching and Heuristic Elimination of Gyro Drift for Personal Navigation Systems in GPS-denied Conditions , 2011 .

[15]  Michael Stock,et al.  INS/GNSS Integration for Aerobatic Flight Applications and Aircraft Motion Surveying , 2017, Sensors.

[16]  Chan Gook Park,et al.  MEMS Based Pedestrian Navigation System , 2005 .

[17]  Bradford W. Parkinson,et al.  Cascaded Kalman Filters for Accurate Estimation of Multiple Biases, Dead-Reckoning Navigation, and Full State Feedback Control of Ground Vehicles , 2007, IEEE Transactions on Control Systems Technology.

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

[19]  Yiqing Yao,et al.  An IMM-Aided ZUPT Methodology for an INS/DVL Integrated Navigation System , 2017, Sensors.

[20]  F. Seco,et al.  A comparison of Pedestrian Dead-Reckoning algorithms using a low-cost MEMS IMU , 2009, 2009 IEEE International Symposium on Intelligent Signal Processing.

[21]  H. Haas,et al.  Pedestrian Dead Reckoning : A Basis for Personal Positioning , 2006 .

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

[23]  Johann Borenstein,et al.  Heuristic Drift Elimination for Personnel Tracking Systems , 2010, Journal of Navigation.

[24]  Guoliang Chen,et al.  Integrated WiFi/PDR/Smartphone Using an Unscented Kalman Filter Algorithm for 3D Indoor Localization , 2015, Sensors.

[25]  So Young Park,et al.  A pedestrian dead-reckoning system that considers the heel-strike and toe-off phases when using a foot-mounted IMU , 2015 .

[26]  Shesheng Gao,et al.  Multi-sensor Optimal Data Fusion for INS/GNSS/CNS Integration Based on Unscented Kalman Filter , 2018 .

[27]  J B King,et al.  Gait Analysis. An Introduction , 1992 .

[28]  J.W. Kim,et al.  Adaptive Step Length Estimation Algorithm Using Low-Cost MEMS Inertial Sensors , 2007, 2007 IEEE Sensors Applications Symposium.

[29]  Sangjoon Park,et al.  Advanced Heuristic Drift Elimination for indoor pedestrian navigation , 2014, 2014 International Conference on Indoor Positioning and Indoor Navigation (IPIN).

[30]  Naser El-Sheimy,et al.  Tightly-Coupled Integration of WiFi and MEMS Sensors on Handheld Devices for Indoor Pedestrian Navigation , 2016, IEEE Sensors Journal.

[31]  B. Krach,et al.  Cascaded estimation architecture for integration of foot-mounted inertial sensors , 2008, 2008 IEEE/ION Position, Location and Navigation Symposium.

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

[33]  Christian Eling,et al.  Real-Time Single-Frequency GPS/MEMS-IMU Attitude Determination of Lightweight UAVs , 2015, Sensors.

[34]  Yan Li,et al.  A Pedestrian Navigation System Based on Low Cost IMU , 2014, Journal of Navigation.

[35]  Fernando Seco Granja,et al.  Accurate Pedestrian Indoor Navigation by Tightly Coupling Foot-Mounted IMU and RFID Measurements , 2012, IEEE Transactions on Instrumentation and Measurement.

[36]  Xiaoli Meng,et al.  Fusion of Inertial/Magnetic Sensor Measurements and Map Information for Pedestrian Tracking , 2017, Sensors.

[37]  Fabio Leccese,et al.  Improvement of altitude precision in indoor and urban canyon navigation for small flying vehicles , 2015, 2015 IEEE Metrology for Aerospace (MetroAeroSpace).

[38]  Fernando Seco Granja,et al.  Improved heuristic drift elimination with magnetically-aided dominant directions (MiHDE) for pedestrian navigation in complex buildings , 2012, J. Locat. Based Serv..

[39]  Guenther Retscher,et al.  Performance and accuracy test of a WiFi indoor positioning system , 2007 .

[40]  Reynald Hoskinson,et al.  A cascaded Kalman filter-based GPS/MEMS-IMU integration for sports applications , 2015 .

[41]  Ram Dantu,et al.  Magnetic Maps for Indoor Navigation , 2011, IEEE Transactions on Instrumentation and Measurement.

[42]  Cheng Chen,et al.  2D/3D indoor navigation based on multi-sensor assisted pedestrian navigation in Wi-Fi environments , 2012, 2012 Ubiquitous Positioning, Indoor Navigation, and Location Based Service (UPINLBS).

[43]  Francisco Zampella,et al.  Pedestrian navigation fusing inertial and RSS/TOF measurements with adaptive movement/measurement models: Experimental evaluation and theoretical limits , 2013 .

[44]  Huosheng Hu,et al.  Inertial/magnetic sensors based pedestrian dead reckoning by means of multi-sensor fusion , 2018, Inf. Fusion.

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

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

[47]  Huichao Lv,et al.  Fusion of Visible Light Indoor Positioning and Inertial Navigation Based on Particle Filter , 2017, IEEE Photonics Journal.

[48]  Chan Gook Park,et al.  Lever Arm Compensation for GPS/INS/Odometer Integrated System , 2006 .

[49]  Xiaoji Niu,et al.  Tightly-Coupled Integration of Multi-GNSS Single-Frequency RTK and MEMS-IMU for Enhanced Positioning Performance , 2017, Sensors.

[50]  I. Tarkka,et al.  Footprint analysis of gait using a pressure sensor system. , 2004, Journal of electromyography and kinesiology : official journal of the International Society of Electrophysiological Kinesiology.