A Robust Single GPS Navigation and Positioning Algorithm Based on Strong Tracking Filtering

Kalman filter (KF) algorithm is a form of recursive optimal estimations, which utilizes information in time domain with less computational efforts to reduce the system errors. Recently, Kalman filtering technique has become a standard approach for reducing errors in a least squares sense and is widely applied in navigation and positioning fields. Unfortunately, the traditional KF needs accurate statistical information about mobile terminal; otherwise, it will result in lower precision and even divergence. To make up for the deficiency of KF algorithm, this paper presents a novel robust single global position system (GPS) navigation algorithm based on dead reckoning and strong tracking filter (STF), which still has strong tracking ability even when precise knowledge of the system models is not available. The proposed algorithm utilizes adaptive fading factor to adjust the gain matrix in real time to satisfy the orthogonality principle (OP), which indicates all useful information has been extracted from residual. Furthermore, we define residual covariance (RC) as an important index to evaluate the performance of the filtering algorithm and deduce the closed relationship of RCs in KF under the case of: 1) inaccurate system model; 2) erroneous initial value; and 3) abrupt change of states, respectively. We find that the RCs of the KF algorithm under all three above-mentioned cases have a bias compared with desired ones; as a result, they do not conform to the OP and have poor tracking ability, while the RC of STF conforms to the OP due to the fading factor which indicates the tracking performance is greatly improved in the proposed algorithm. The theoretical analysis and simulation results demonstrate that the performance of the proposed single GPS navigation algorithm based on STF outperforms that of the traditional KF algorithm.

[1]  Myeong-Jong Yu,et al.  INS/GPS Integration System using Adaptive Filter for Estimating Measurement Noise Variance , 2012, IEEE Transactions on Aerospace and Electronic Systems.

[2]  S. Y. Chen,et al.  Kalman Filter for Robot Vision: A Survey , 2012, IEEE Transactions on Industrial Electronics.

[3]  George Pavlou,et al.  Cost-Efficient Low Latency Communication Infrastructure for Synchrophasor Applications in Smart Grids , 2018, IEEE Systems Journal.

[4]  Su Wan-Xin Application of Sage-Husa adaptive filtering algorithm for high precision SINS initial alignment , 2014, 2014 11th International Computer Conference on Wavelet Actiev Media Technology and Information Processing(ICCWAMTIP).

[5]  Zhu Yanping,et al.  Target tracking algorithm based on adaptive strong tracking particle filter , 2016 .

[6]  Jang Gyu Lee,et al.  Adaptive Two-Stage Extended Kalman Filter for a Fault-Tolerant INS-GPS Loosely Coupled System , 2009, IEEE Transactions on Aerospace and Electronic Systems.

[7]  Hailiang Xiong An Efficient Narrowband Interference Suppression Approach in Ultra-Wideband Receiver , 2017, IEEE Sensors Journal.

[8]  Liu Shirong,et al.  An improved Sage-Husa adaptive filtering algorithm , 2012, Proceedings of the 31st Chinese Control Conference.

[9]  Julian Cheng,et al.  Investigation of short-range high precision 3D localization via UWB radio , 2014, 2014 IEEE Global Communications Conference.

[10]  Antonio J. Conejo,et al.  A sensitivity analysis method to compute the residual covariance matrix , 2011 .

[11]  Gang Yin,et al.  An Accurate GPS-IMU/DR Data Fusion Method for Driverless Car Based on a Set of Predictive Models and Grid Constraints , 2016, Sensors.

[12]  P. Frank,et al.  Strong tracking filtering of nonlinear time-varying stochastic systems with coloured noise: application to parameter estimation and empirical robustness analysis , 1996 .

[13]  Feng Sun,et al.  Strong tracking cubature Kalman filter algorithm for GPS/INS Integrated Navigation System , 2013, 2013 IEEE International Conference on Mechatronics and Automation.

[14]  Qing Wang,et al.  A Kalman filter for UWB positioning in LOS/NLOS scenarios , 2016, 2016 Fourth International Conference on Ubiquitous Positioning, Indoor Navigation and Location Based Services (UPINLBS).

[15]  Moe Z. Win,et al.  Fundamental Limits of Wideband Localization— Part I: A General Framework , 2010, IEEE Transactions on Information Theory.

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

[17]  Moe Z. Win,et al.  Fundamental Limits of Wideband Localization— Part II: Cooperative Networks , 2010, IEEE Transactions on Information Theory.

[18]  Wei Shi,et al.  Fingerprinting localization based on 60 GHz impulse radio , 2015, 2015 IEEE Pacific Rim Conference on Communications, Computers and Signal Processing (PACRIM).

[19]  Nanbo Liu,et al.  Effective Sage-Husa Kalman filter for SINS/Doppler/Platform Compass integrated navigation system , 2016, 2016 IEEE Chinese Guidance, Navigation and Control Conference (CGNCC).

[20]  Zhu Xiao,et al.  Hybrid Cooperative Vehicle Positioning Using Distributed Randomized Sigma Point Belief Propagation on Non-Gaussian Noise Distribution , 2016, IEEE Sensors Journal.

[21]  Dah-Jing Jwo,et al.  Adaptive Fuzzy Strong Tracking Extended Kalman Filtering for GPS Navigation , 2007, IEEE Sensors Journal.

[22]  Dah-Jing Jwo,et al.  An Adaptive Fuzzy Strong Tracking Kalman Filter for GPS/INS Navigation , 2007, IECON 2007 - 33rd Annual Conference of the IEEE Industrial Electronics Society.

[23]  J. Asgari,et al.  Improving MEMS-IMU/GPS integrated systems for land vehicle navigation applications , 2015, GPS Solutions.

[24]  Chau Yuen,et al.  Fusing Similarity-Based Sequence and Dead Reckoning for Indoor Positioning Without Training , 2017, IEEE Sensors Journal.

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

[26]  Raman K. Mehra,et al.  Approaches to adaptive filtering , 1970 .

[27]  Hugh F. Durrant-Whyte,et al.  The aiding of a low-cost strapdown inertial measurement unit using vehicle model constraints for land vehicle applications , 2001, IEEE Trans. Robotics Autom..

[28]  Dongfeng Yuan,et al.  Front-End Narrowband Interference Mitigation for DS-UWB Receiver , 2013, IEEE Transactions on Wireless Communications.

[29]  Jie Zhang,et al.  A novel indoor localization scheme , 2010, 2010 IEEE 12th International Conference on Communication Technology.

[30]  Chih-Lung Lin,et al.  Position Estimation and Smooth Tracking With a Fuzzy-Logic-Based Adaptive Strong Tracking Kalman Filter for Capacitive Touch Panels , 2015, IEEE Transactions on Industrial Electronics.

[31]  Bin Li,et al.  A Reliable Hybrid Positioning Methodology for Land Vehicles Using Low-Cost Sensors , 2016, IEEE Transactions on Intelligent Transportation Systems.

[32]  Xiufeng He,et al.  MEMS IMU and two-antenna GPS integration navigation system using interval adaptive Kalman filter , 2013, IEEE Aerospace and Electronic Systems Magazine.

[33]  Seong Yun Cho,et al.  Robust positioning technique in low-cost DR/GPS for land navigation , 2006, IEEE Transactions on Instrumentation and Measurement.

[34]  Jing Li,et al.  A Novel Complex-Coefficient In-Band Interference Suppression Algorithm for Cognitive Ultra-Wide Band Wireless Sensors Networks , 2017, Sensors.

[35]  Chenglin Wen,et al.  Carrier Tracking Estimation Analysis by Using the Extended Strong Tracking Filtering , 2017, IEEE Transactions on Industrial Electronics.

[36]  M.N.S. Swamy,et al.  GPS navigation with increased immunity to modeling errors , 2004, IEEE Transactions on Aerospace and Electronic Systems.