GPS/INS navigation based on adaptive finite impulse response-Kalman filter algorithm

被引:0
|
作者
Jin B. [1 ,2 ,3 ]
Li J. [1 ]
Zhu D. [1 ]
Guo J. [1 ,2 ,3 ]
Su B. [1 ,2 ,3 ]
机构
[1] College of Mechanical and Electronic Engineering, Northwest A&F University, Yangling
[2] Key Laboratory of Agricultural Internet of Things, Ministry of Agriculture and Rural Affairs, Yangling
[3] Shaanxi Key Laboratory of Agricultural Information Perception and Intelligent Service, Yangling
关键词
Adaptive Kalman filtering; FIR prediction model; Global positioning system; Models; Navigation;
D O I
10.11975/j.issn.1002-6819.2019.03.010
中图分类号
学科分类号
摘要
Global positioning system (GPS) and inertial navigation system (INS) are widely used in target positioning, vehicle navigation, precision agriculture and other fields. However, due to factors such as satellite signal occlusion, multi-path effect and observation error, the filtering results usually have large errors. Kalman filtering algorithm is generally used in navigation and positioning system to improve positioning accuracy. The performance of kalman filter algorithm depends on the dynamic model of state vector and the random model describing noise characteristics. There are 2 corresponding adaptive kalman filtering algorithms: one is the multiple-model-based adaptive estimation (MMAE); the other is the innovation-based adaptive estimation (IAE). The first method is to combine all models with non-zero model probability by using a set of parallel kalman filters under different dynamic models and statistical information. The second method complete the adaptive filtering directly by calculating the observation noise or process noise covariance matrix based on the change of information sequence. In MMAE and IAE methods, discrete time differential models are usually adopted, such as the constant velocity CV model and constant acceleration CA model, to describe the change process of state variables. However, the state vectors such as position, velocity and attitude are correlated, and it is very difficult to accurately describe the statistical relations of these states. When the prior information is not sufficient, the coupling effect of each filtering state will also cause large errors to the positioning results. Another disadvantage of kalman filter algorithm based on discrete time differential model is that it highly depends on the prior statistical information of process noise and observation noise. Generally, the prior statistical information of process noise and measurement noise depends on the motion process and application scene, which is difficult to be obtained accurately. Insufficient prior statistical information of the filter will reduce the estimation accuracy of the filter state and even lead to the divergence of the filter estimation results. The research of adaptive kalman filter algorithm is mainly focused on the covariance of online calculation process noise or measured noise. In order to improve the accuracy of navigation and positioning, an adaptive kalman filter algorithm based on FIR (finite impulse response) prediction model for white noise background was proposed in this paper. Firstly, the continuous trajectory function of moving target was approximated by an N-order polynomial with arbitrary precision, and the FIR prediction model polynomial was obtained. The FIR prediction model coefficient was obtained by solving a convex quadratic programming problem, and the optimal solution of FIR prediction model coefficient was solved by lagrange multiplier method. The convex quadratic programming taken the polynomial motion law of the target as the constraint condition and the minimum white noise gain as the objective function, and the optimal solution could not only satisfy the constraints of the target's motion state, but also had the effect of de-noising to a certain extent. Finally, the proposed FIR prediction model was combined with kalman filter. Simulation test and the measurement results showed that kalman filtering algorithm based on FIR prediction model had higher estimation accuracy than the traditional kalman filtering algorithm under the same parameter settings, and the simulation experiment results showed that the localization precision was increased by 29.54%, the measured experimental results showed that positioning accuracy in east-west direction increased by 21.71%, positioning error in north-south direction increased by 22.62%. The proposed algorithm could be used for single state estimation before information fusion in loosely coupled GPS/INS, and also for noise reduction in post-processing of GPS receivers. © 2019, Editorial Department of the Transactions of the Chinese Society of Agricultural Engineering. All right reserved.
引用
收藏
页码:75 / 81
页数:6
相关论文
共 25 条
  • [1] Li Z., Wang J., Gao J., Et al., The application of adaptive federated filter in GPS-INS-Odometer integrated navigation, Acta Geodaetica et Cartographica Sinica, 45, 2, pp. 157-163, (2016)
  • [2] Tan X., Wang J., Han H., SVR aided adaptive robust filtering algorithm for GPS/INS integrated navigation, Acta Geodaetica et Cartographica Sinica, 43, 6, (2014)
  • [3] Zhao H.S., Miao L.J., Shao H.J., Adaptive two-stage kalman filter for SINS/Odometer integrated navigation systems, Journal of Navigation, 70, 2, pp. 242-261, (2016)
  • [4] Kim J., Kiss B., Lee D., An adaptive unscented kalman filtering approach using selective scaling, IEEE International Conference on Systems, pp. 784-789, (2017)
  • [5] Lin S.G., Assisted adaptive extended kalman filter for low-cost single-frequency GPS/SBAS kinematic positioning, GPS Solutions, 19, 2, pp. 215-223, (2015)
  • [6] Tan X., Wang J., Zhao C., Neural network aided adaptive UKF algorithm for GPS/INS integrated navigation, Acta Geodaetica et Cartographica Sinica, 44, 4, pp. 384-391, (2015)
  • [7] Sarkka S., Tolvanen V., Kannala J., Et al., Adaptive kalman filtering and smoothing for gravitation tracking in mobile systems, IEEE International Conference on Indoor Positioning and Indoor Navigation, pp. 1-7, (2015)
  • [8] Qin K., Dong X., Chen Y., Huber-based robust high-degree cubature kalman filter algorithm, Computer Engineering and Applications, 53, 7, pp. 21-29, (2017)
  • [9] Niehen W., Adaptive kalman filtering based on matched filtering of the innovation sequence, Proceedings of the 7th International Conference on Information Fusion, pp. 362-369, (2004)
  • [10] Hide C., Moore T., Smith M., Multiple model kalman filtering for GPS and low-cost INS integration, Proceedings of the 17th International Technical Meeting of the Satellite Division of the Institute of Navigation, pp. 1096-1103, (2004)