Robustly Adaptive EKF PDR/UWB Integrated Navigation Based on Additional Heading Constraint

At present, GNSS (Global Navigation Satellite System) positioning technology is widely used for outdoor positioning services because of its high-precision positioning characteristics. However, in indoor environments, effective position information cannot be provided, because of the signals being obscured. In order to improve the accuracy and continuity of indoor positioning systems, in this paper, we propose a PDR/UWB (Pedestrian Dead Reckoning and Ultra Wide Band) integrated navigation algorithm based on an adaptively robust EKF (Extended Kalman Filter) to address the problem of error accumulation in the PDR algorithm and gross errors in the location results of the UWB in non-line-of-sight scenarios. First, the basic principles of UWB and PDR location algorithms are given. Then, we propose a loose combination of the PDR and UWB algorithms by using the adaptively robust EKF. By using the robust factor to adjust the weight of the observation value to resist the influence of the gross error, and by adjusting the variance of the system adaptively according to the positioning scene, the algorithm can improve the robustness and heading factor of the PDR algorithm, which is constrained by indoor maps. Finally, the effectiveness of the algorithm is verified by the measured data. The experimental results showed that the algorithm can not only reduce the accumulation of PDR errors, but can also resist the influence of gross location errors under non-line-of-sight UWB scenarios.

[1]  Yue Wang,et al.  A Fusion Algorithm of Indoor Positioning Based on PDR and RSS Fingerprint , 2018, IEEE Sensors Journal.

[2]  Jingjing Wu,et al.  A Robust PDR/UWB Integrated Indoor Localization Approach for Pedestrians in Harsh Environments , 2019, Sensors.

[3]  Matteo Ridolfi,et al.  UWB anchor nodes self-calibration in NLOS conditions: a machine learning and adaptive PHY error correction approach , 2021, Wirel. Networks.

[4]  Yang Yuan,et al.  Adaptive Robust Filtering for Kinematic GPS Positioning , 2001 .

[5]  Jian Cheng,et al.  LOS/NLOS Identification for Indoor UWB Positioning Based on Morlet Wavelet Transform and Convolutional Neural Networks , 2021, IEEE Communications Letters.

[6]  Tim Wark,et al.  A Wireless Sensor Network for Real-Time Indoor Localisation and Motion Monitoring , 2008, 2008 International Conference on Information Processing in Sensor Networks (ipsn 2008).

[7]  Hao Xia,et al.  Multi-Phase Fingerprint Map Based on Interpolation for Indoor Localization Using iBeacons , 2018, IEEE Sensors Journal.

[8]  Georgios B. Giannakis,et al.  Ultra-wideband communications: an idea whose time has come , 2004, IEEE Signal Processing Magazine.

[9]  Wei Li,et al.  Robust adaptive filtering method for SINS/SAR integrated navigation system , 2011 .

[10]  Xiaofeng Yang,et al.  NLOS Mitigation for UWB Localization Based on Sparse Pseudo-Input Gaussian Process , 2018, IEEE Sensors Journal.

[11]  Martin David Adams,et al.  An augmented state SLAM formulation for multiple line-of-sight features with millimetre wave RADAR , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Kevin I-Kai Wang,et al.  A Low-Cost INS and UWB Fusion Pedestrian Tracking System , 2019, IEEE Sensors Journal.

[13]  Tae-Yong Choi,et al.  Adaptive occupancy grid mapping with clusters , 2005, Artificial Life and Robotics.

[14]  Jin feng Li,et al.  An Autonomous Waist-Mounted Pedestrian Dead Reckoning System by Coupling Low-Cost MEMS Inertial Sensors and GPS Receiver for 3D Urban Navigation , 2014 .

[15]  Xiaohong Zhang,et al.  Adaptive robust Kalman filtering for precise point positioning , 2014 .

[16]  Yifan Wang,et al.  WiFi/PDR integrated navigation with robustly constrained Kalman filter , 2020, Measurement Science and Technology.

[17]  Xin Li,et al.  An Improved WiFi/PDR Integrated System Using an Adaptive and Robust Filter for Indoor Localization , 2016, ISPRS Int. J. Geo Inf..

[18]  Jian Wang,et al.  An Enhanced GPS/INS Integrated Navigation System with GPS Observation Expansion , 2016 .

[19]  Tianhe Xu,et al.  Robust estimator for correlated observations based on bifactor equivalent weights , 2002 .

[20]  Moe Z. Win,et al.  Ranging With Ultrawide Bandwidth Signals in Multipath Environments , 2009, Proceedings of the IEEE.

[21]  Peng Zhang,et al.  WiFi-Aided Magnetic Matching for Indoor Navigation with Consumer Portable Devices , 2015, Micromachines.

[22]  Jamshaid Ali,et al.  A consistent and robust Kalman filter design for in-motion alignment of inertial navigation system , 2009 .

[23]  Guobin Chang,et al.  Kalman filter with both adaptivity and robustness , 2014 .

[24]  Yuanxi Yang,et al.  Adaptively robust filtering for kinematic geodetic positioning , 2001 .

[25]  Qin Zhang,et al.  Real-time estimation of satellite clock offset using adaptively robust Kalman filter with classified adaptive factors , 2012, GPS Solutions.

[26]  Xianqiang Cui,et al.  Adaptively robust filter with multi adaptive factors , 2008 .

[27]  Yang Yuan-xi.  Integrated Navigation by Using Variance Component Estimates of Multi-sensor Measurements and Adaptive Weights of Dynamic Model Information , 2004 .

[28]  Cipriano Galindo,et al.  Mobile robot localization based on Ultra-Wide-Band ranging: A particle filter approach , 2009, Robotics Auton. Syst..

[29]  Agathoniki Trigoni,et al.  Non-Line-of-Sight Identification and Mitigation Using Received Signal Strength , 2015, IEEE Transactions on Wireless Communications.

[30]  Davide Dardari,et al.  Occupancy Grid Mapping for Personal Radar Applications , 2018, 2018 IEEE Statistical Signal Processing Workshop (SSP).

[31]  Sinan Gezici,et al.  A Survey on Wireless Position Estimation , 2008, Wirel. Pers. Commun..

[32]  Fei Liu,et al.  An Indoor Localization Method for Pedestrians Base on Combined UWB/PDR/Floor Map , 2019, Sensors.

[33]  Ye Kuang,et al.  A UWB/Improved PDR Integration Algorithm Applied to Dynamic Indoor Positioning for Pedestrians , 2017, Sensors.

[34]  Xizhong Lou,et al.  Correction to: NLOS Identification for Localization Based on the Application of UWB , 2021, Wireless Personal Communications.

[35]  Halil Ersin Soken,et al.  Robust Kalman filtering for small satellite attitude estimation in the presence of measurement faults , 2014, Eur. J. Control.

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

[37]  Ismail Güvenç,et al.  NLOS Identification and Mitigation for UWB Localization Systems , 2007, 2007 IEEE Wireless Communications and Networking Conference.

[38]  N. Patrikalakis,et al.  Predicting Millimeter Wave Radar Spectra for Autonomous Navigation , 2010, IEEE Sensors Journal.

[39]  Shuli Guo,et al.  An Improved PDR/UWB Integrated System for Indoor Navigation Applications , 2020, IEEE Sensors Journal.

[40]  Alessio De Angelis,et al.  Analysis of Nonideal Effects and Performance in Magnetic Positioning Systems , 2016, IEEE Transactions on Instrumentation and Measurement.

[41]  Jian Wang,et al.  A Floor-Map-Aided WiFi/Pseudo-Odometry Integration Algorithm for an Indoor Positioning System , 2015, Sensors.