Performance assisted enhancement based on change point detection and Kalman filtering

Abstract

A performance assisted enhancement Kalman filtering algorithm (PAE-KF) for GPS/INS integration navigation in urban areas was presented in this work. The aim of this PAE-KF algorithm was to prevent “deep contamination” caused by error GPS data. This filtering algorithm effectively combined fault estimation of raw GPS data and nonholonomic constraint of vehicle. In fault estimation, a change point detection algorithm based on abrupt change model was proposed. Statistical tool was then used to infer the future bound of GPS data, which can detect faults in GPS raw data. If any kinds of faults were detected, dead reckoning mechanism begins to compute current position. Nonholonomic constraint condition of vehicle was used to estimate velocity of vehicle and change point detection was added into classic Kalman filtering structure. Experiment on vehicle shows that even when the GPS signals are unavailable for a period of time, this method can also output high accuracy data.

Keywords

change point detection / Kalman filtering / nonholonomic constraint / GPS/INS integrated navigation system

References

[1] CaronF, DuflosE, PomorskiD, VanheegheP. GPS/IMU data fusion using multi-sensor kalman filtering introduction of contextual aspects [J]. Information Fusion, 2006, 7(2): 221-230

[2] LiZ H, HenryL. GPS/INS integration based navigation with multipath mitigation for intelligent vehicles [C]. Proceedings of ICM2007 4th IEEE International Conference on Mechatronics, 2007New YorkIEEE Engineering Society1-5

[3] CaiZ-x, LiuX-b, RenX-ping. CSAIE novel clonal selection algorithm with information exchange for high dimensional global optimization problems [J]. Lecture Notes in Computer Science, 2012, 7597: 218-231

[4] RenX-p, XueZ-c, ZhaoKe. Measurement error detection, elimination method and its application [J]. Applied Mechanics and Materials, 2013990-993

[5] CaiZ-x, GuM-q, LiYi. Real-time arrow traffic light recognition system for intelligent vehicle [C]. The 16th International Conference on Image Processing, Computer Vision, & Pattern Recognition, 2012New YorkIEEE Society848-854

[6] LiZ, CaiZ-x, RenX-p, ChenA-b, XueZ-chao. Vehicle kinematics modeling and design of vehicle trajectory generator system [J]. Journal of Central South University, 2012, 19(10): 2860-2865

[7] SukkariehSLow cost, high integrity, aided inertial navigation systems for autonomous land vehicles [D], 2000SydneyAustralian Centre for Field Robotics, University of Sydney

[8] ShinE HAccuracy improvement of low cost INS/GPS for land applications [D], 2001Calgary, AlbertaDepartment of Geomantic Engineering, Calgary University

[9] NikiforovI. A lower bound for the detection/isolation delay in a class of sequential tests [J]. IEEE Transactions on Information Theory, 2003, 49(11): 3037-3047

[10] NikiforovI. Reliable detection of faults in navigation systems [C]. Proceedings of the 38th IEEE Conference on Decision and Control, 1999, 5: 4976-4981

[11] WangW, LiuZ-y, XieR-rong. Quadratic extended Kalman filter approach for GPS INS integration [J]. Aerospace Science and Technology, 2006, 10(8): 709-713

[12] WangJ H, GaoY. GPS-based land vehicle navigation system assisted by a low-cost gyro-free INS using neural network [J]. Journal of Navigation, 2004, 57(3): 417-428

[13] CaiZ-x, RenX-p, ChenB-f, YuL-li. Anomaly detection method based on kinematics model and nonholonomic constraint of vehicle [J]. Journal of Central South University of Technology, 2011, 18(4): 1128-1132

[14] GodhaS, CannonM E. GPS/MEMS INS integrated system for navigation in urban areas [J]. GPS Solutions, 2007, 11(3): 193-203

[15] BassevilleM, NikiforovI. Fault isolation for diagnosis: Nuisance rejection and multiple hypotheses testing [J]. Annual Reviews in Control, 2002, 26(2): 189-202

[16] NikiforovI. A generalized change detection problem [J]. IEEE Transactions on Information Theory, 1995, 41(1): 171-187

[17] RenX-p, CaiZ-x, HeH-g, XueZ-chao. Fault detection method based on varying-length scanning model and its application to the integrated GPS/INS navigation system [J]. Robots, 2011, 33(4): 502-508

[18] GuM-q, CaiZ-xing. Traffic sign recognition using dual tree-complex wavelet transform and 2D independent component analysis [C]. Proceedings of the 10th World Congress on Intelligent Control and Automation, 2012New YorkIEEE Society4623-4627