Abstract
To further enhance the positioning accuracy and stability of the INS/GNSS integrated navigation system, we present a new fuzzy strong tracking cubature Kalman filter (FSTCKF) algorithm for data fusion. A fuzzy logic controller is designed for the strong tracking cubature Kalman filter (STCKF), which aims at strengthening the filter’s ability to identify and respond to the dynamics. Chi-square tests are separately conducted on the innovation vector in order to reveal the dynamic properties inside the velocity and position states. Thereafter, parallel fuzzy inferences are conducted to generate a time-varying smoothing factor matrix, which helps the STCKF obtain the multiple fading factors distributed to each state variable. Numerical simulations and real data testing results demonstrate the superiority and robustness of the proposed FSTCKF algorithm. Not only can the proposed algorithm maintain the accuracy and stability in steady conditions, but further increase the dynamic tracking ability as well. Finally, the positioning performances of the INS/GNSS can be improved.
Similar content being viewed by others
Data availability
The datasets generated and analyzed during the current study are available from the corresponding author on reasonable request.
References
Barton J (2012) SUAS code: UAV state estimation examples. File exchange—MATLAB central. https://www.mathworks.com/matlabcentral/fileexchange/68511-suas-code-uav-state-estimation-examples?s_tid=srchtitle. http://www.pudn.com/Download/item/id/2587568.html
Chen B, Lin C, Liu X, Liu K (2015) Adaptive fuzzy tracking control for a class of MIMO nonlinear systems in nonstrict-feedback form. IEEE Trans Cybern 45(12):2744–2755. https://doi.org/10.1109/TCYB.2014.2383378
Cui B, Chen X, Tang X (2017) Improved cubature Kalman filter for GNSS/INS based on transformation of posterior sigma-points error. IEEE Trans Signal Process 65(11):2975–2987. https://doi.org/10.1109/TSP.2017.2679685
Doostdar P, Keighobadi J, Hamed MA (2020) INS/GNSS integration using recurrent fuzzy wavelet neural networks. GPS Solut 24(1):1. https://doi.org/10.1007/s10291-019-0942-z
Ge Q, Shao T, Chen S, Wen C (2017) Carrier tracking estimation analysis by using the extended strong tracking filtering. IEEE Trans Ind Electron 64(2):1415–1424. https://doi.org/10.1109/TIE.2016.2610403
Geng Y, Wang J (2008) Adaptive estimation of multiple fading factors in Kalman filter for navigation applications. GPS Solut 12(4):273–279. https://doi.org/10.1007/s10291-007-0084-6
Huang W, Xie H, Shen C, Li J (2016) A robust strong tracking cubature Kalman filter for spacecraft attitude estimation with quaternion constraint. Acta Astronaut 121:153–163. https://doi.org/10.1016/j.actaastro.2016.01.009
Hwang C, Lai J, Lin Z (2020) Sensor-fused fuzzy variable structure incremental control for partially known nonlinear dynamic systems and application to an outdoor quadrotor. IEEE/ASME Trans Mechatron 25(2):716–727. https://doi.org/10.1109/TMECH.2020.2972295
Jia B, Xin M (2016) Adaptive cubature Kalman filter with directional uncertainties. IEEE Trans Aerosp Electron Syst 52(3):1477–1486. https://doi.org/10.1109/TAES.2016.140955
Jwo D, Wang S (2007) Adaptive fuzzy strong tracking extended Kalman filtering for GPS navigation. IEEE Sensors J 7(5):778–789. https://doi.org/10.1109/JSEN.2007.894148
Kang C, Park C, Song J (2016) An adaptive complementary Kalman filter using fuzzy logic for a hybrid head tracker system. IEEE Trans Instrum Meas 65(9):2163–2173. https://doi.org/10.1109/TIM.2016.2575178
Li W, Sun S, Jia Y, Du J (2016) Robust unscented Kalman filter with adaptation of process and measurement noise covariances. Digit Signal Process 48:93–103. https://doi.org/10.1016/j.dsp.2015.09.004
Li Z, Yang W, Ding D (2017) Strong tracking cubature Kalman filter for real-time orbit determination for impulse maneuver satellite. In: Proceedings of the 36th Chinese control conference, pp 5258–5263
Lin C, Chang Y, Hung C, Tu C, Chuang C (2015) Position estimation and smooth tracking with a fuzzy-logic-based adaptive strong tracking Kalman filter for capacitive touch panels. IEEE Trans Ind Electron 62(8):5097–5108. https://doi.org/10.1109/TIE.2015.2396874
Liu W, Liu Y, Bucknall R (2019) A robust localization method for unmanned surface vehicle (USV) navigation using fuzzy adaptive Kalman filtering. IEEE Access 7:46071–46083. https://doi.org/10.1109/ACCESS.2019.2909151
Miao Z, Lv Y, Xu D, Shen F, Pang S (2017) Analysis of a variational Bayesian adaptive cubature Kalman filter tracking loop for high dynamic conditions. GPS Solut 21(1):111–122. https://doi.org/10.1007/s10291-015-0510-0
Ning X, Wang F, Fang J (2017) An implicit UKF for satellite stellar refraction navigation system. IEEE Trans Aerosp Electron Syst 53(3):1489–1503. https://doi.org/10.1109/TAES.2017.2671684
Ning X, Zhang J, Gui M, Fang J (2018) A fast calibration method of the star sensor installation error based on observability analysis for the tightly coupled SINS/CNS-integrated navigation system. IEEE Sensors J 18(16):6794–6803. https://doi.org/10.1109/JSEN.2018.2850779
Nourmohammadi H, Keighobadi J (2018) Design and experimental evaluation of indirect centralized and direct decentralized integration scheme for low-cost INS/GNSS system. GPS Solut 22(3):65–82. https://doi.org/10.1007/s10291-018-0732-z
Qin X, Fang H, Liu X (2016) Strong tracking filter based fault diagnosis of networked control system with multiple packet dropouts and parameter perturbations. Circuits Syst Signal Process 35(7):2331–2350. https://doi.org/10.1007/s00034-015-0142-1
Richardson J, Korniak J, Reiner PD, Wilamowski BM (2016) Nearest-neighbor spline approximation (NNSA) improvement to TSK fuzzy systems. IEEE Trans Ind Inf 12(1):169–178. https://doi.org/10.1109/TII.2015.2499122
Tanil C, Khanafseh S, Joerger M, Pervan B (2018) An INS monitor to detect GNSS spoofers capable of tracking vehicle position. IEEE Trans Aerosp Electron Syst 54(1):131–143. https://doi.org/10.1109/TAES.2017.2739924
Wang M, Shan T, Ma L, Tao R, Chen C (2018a) Performance of GPS and GPS/SINS navigation in the CE-5T1 skip re-entry mission. GPS Solut 22(2):56–67. https://doi.org/10.1007/s10291-018-0720-3
Wang M, Wu W, Zhou P, He X (2018b) State transformation extended Kalman filter for GPS/SINS tightly coupled integration. GPS Solut 22(4):112–123. https://doi.org/10.1007/s10291-018-0773-3
Wang X, Xu Z, Gou X, Trajković L (2020) Tracking a maneuvering target by multiple sensors using extended Kalman filter with nested probabilistic-numerical linguistic information. IEEE Trans Fuzzy Syst 28(2):346–360. https://doi.org/10.1109/TFUZZ.2019.2906577
Yang C, Shi W, Chen W (2018) Correlational inference-based adaptive unscented Kalman filter with application in GNSS/IMU-integrated navigation. GPS Solut 22(4):100–113. https://doi.org/10.1007/s10291-018-0766-2
Yang Y, Li B, Wu X, Yang L (2020) Application of adaptive cubature Kalman filter to in-pipe survey system for 3D small-diameter pipeline mapping. IEEE Sensors J 20(12):6331–6337. https://doi.org/10.1109/JSEN.2020.2976579
Yin Z, Li G, Zhang Y, Liu J (2019) Symmetric-strong-tracking-extended-Kalman-filter-based sensorless control of induction motor drives for modeling error reduction. IEEE Trans Ind Inf 15(2):650–662. https://doi.org/10.1109/TII.2018.2810850
Zhao Y (2016) Performance evaluation of cubature Kalman filter in a GPS/IMU tightly-coupled navigation system. Signal Process 119:67–79. https://doi.org/10.1016/j.sigpro.2015.07.014
Zhou D, Frank PM (1996) Strong tracking filtering of nonlinear time-varying stochastic systems with coloured noise: application to parameter estimation and empirical robustness analysis. Int J Control 65(2):295–307. https://doi.org/10.1080/00207179608921698
Acknowledgements
This work was in part supported by the National Natural Science Foundation of China under Grant 61871033.
Author information
Authors and Affiliations
Corresponding author
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
About this article
Cite this article
Chang, Y., Wang, Y., Shen, Y. et al. A new fuzzy strong tracking cubature Kalman filter for INS/GNSS. GPS Solut 25, 120 (2021). https://doi.org/10.1007/s10291-021-01148-5
Received:
Accepted:
Published:
DOI: https://doi.org/10.1007/s10291-021-01148-5