Abstract
Vehicle tracking is a core problem hindering multisensor fusion in intelligent driving. The interference caused by measurement outliers and motion estimation model mismatch seriously affects the estimation accuracy of target states. In view of these problems, an adaptive vehicle target tracking enhancement algorithm based on fuzzy interacting multiple model robust cubature Kalman filtering (FLIMM-IARCKF) is developed. In this algorithm, we constructed a derivative-free adaptive robust cubature Kalman filter (IARCKF) to suppress measurement outliers and errors in motion estimation modeling. Furthermore, a combined fuzzy reasoning method is developed to work with the interacting multiple model algorithm, which further enhances the target tracking performance by increasing the efficiency of model probability updating and by adaptively regulating the process noise covariance matrix. Simulated experiments verify the effectiveness of the IARCKF algorithm and reflect the advantages of the FLIMM-IARCKF algorithm in estimation accuracy, robustness, and model transformation efficiency when compared to the STCKF (Yun et al in Measurement 191:110063, 2022), Huber-CKF (Tseng et al in J Navig 70(3):527–546, 2017), MRCKF (Wu et al Acta Phys Sin 64(21):218401, 2015. https://doi.org/10.7498/aps.64.218401) and IMM-CKF (Song et al in ISA Trans 12(6):387–395, 2020) algorithms. The results show that the mean absolute percentage error (MAPE) of FLIMM-IARCKF in average position and velocity improved over the aforementioned approaches by 33.48%, and the average root-mean-square error (RMSE) improved by 32.64%. Real vehicle experiments showed that the average MAPE of FLIMM-IARCKF when used to determine position and velocity improved by 25.70%; the average RMSE improved by 28.96% when compared to the aforementioned algorithms, with an average operational time of 56.13 ms. Experimental results further revealed that FLIMM-IARCKF shows superior performance in vehicle target tracking without influencing execution efficiency.
Similar content being viewed by others
Availability of data and materials
The data that support the findings of this study are available from Liuzhou Dongfeng Automobile Company Ltd., but restrictions apply to the availability of these data, which were used under license for the current study and so are not publicly available. Data are, however, available from the authors upon reasonable request and with permission of Liuzhou Dongfeng Automobile Company Ltd.
References
L. Chang, B. Hu, G. Chang, A. Li, Multiple outliers suppression derivative-free filter based on unscented transformation. J. Guid. Control. Dyn. 35(6), 1902–1906 (2012)
M. Chen, C. Gao, Z. Ren, Robust covariance and scatter matrix estimation under Huber’s contamination model. Ann. Stat. 46(5), 1932–1960 (2018)
Y. Deng, Z. Mo, H. Lu, Robust \(h_{\infty }\) state estimation for a class of complex networks with dynamic event-triggered scheme against hybrid attacks. Chin. Phys. B. 31(2), 020503 (2022)
Z. Deng, L. Yin, B. Huo, Y. Xia, Adaptive robust unscented Kalman filter via fading factor and maximum correntropy criterion. Sensors 18(8), 2406 (2018)
H. Fu, Y. Cheng, C. Cheng, A novel improved cubature Kalman filter with adaptive generation of cubature points and weights for target tracking. Meas. Sci. Technol. 33(3), 035002 (2021)
M.A. Gandhi, L. Mili, Robust Kalman filter based on a generalized maximum-likelihood-type estimator. IEEE Trans. Signal Process. 58(5), 2509–2520 (2009)
M.S. Grewal, Kalman Filtering: Theory and Practice Using MATLAB, 2nd edn. (Wiley, New York, 2008)
B. Han, H. Huang, L. Lei, C. Huang, Z. Zhang, An improved IMM algorithm based on stsrckf for maneuvering target tracking. IEEE Access 7, 57795–57804 (2019)
D.-J. Jwo, S.-Y. Lai, Navigation integration using the fuzzy strong tracking unscented Kalman filter. J. Navig. 62(2), 303–322 (2009)
K. Kumar, Robust statistics, by PJ Huber & EM Ronchetti [book review]. J. R. Stat. Soc. A. Stat. Ser. A: Stat. Soc. 174, 241–242 (2011)
X.R. Li, V.P. Jilkov, Survey of maneuvering target tracking. Part I. Dynamic models. IEEE Trans. Aerosp. Elec. Syst. 39(4), 1333–1364 (2003)
Y. Li, L. Hou, Y. Yang, J. Tong, Huber’s M-estimation-based cubature Kalman filter for an INS/DVL integrated system. Math. Probl. Eng. 2020 (2020)
Y. Li, J. Li, J. Qi, L. Chen, Robust cubature Kalman filter for dynamic state estimation of synchronous machines under unknown measurement noise statistics. IEEE Access 7, 29139–29148 (2019)
E. Masazade, M. Fardad, P.K. Varshney, Sparsity-promoting extended Kalman filtering for target tracking in wireless sensor networks. IEEE Signal Proc. Lett. 19(12), 845–848 (2012)
Q. Meng, H. Leib, X. Li, Cubature ensemble Kalman filter for highly dimensional strongly nonlinear systems. IEEE Access 8, 144892–144907 (2020)
J.C. Santos-Leon, R. Orive, D. Acosta, L. Acosta, The cubature Kalman filter revisited. Automatica 127, 109541 (2021)
R. Schubert, C. Adam, M. Obst, N. Mattern, V. Leonhardt, G. Wanielik, Empirical evaluation of vehicular models for ego motion estimation, pp. 534–539 (2011). https://doi.org/10.1109/IVS.2011.5940526
J. Shao, W. Chen, Y. Zhang, F. Yu, J. Wang, Adaptive maximum correntropy based robust CKF with variational Bayesian for covariance estimation. Measurement 202, 111834 (2022)
K. Shen, Z. Jing, P. Dong, A consensus nonlinear filter with measurement uncertainty in distributed sensor networks. IEEE Signal Process. Lett. 24(11), 1631–1635 (2017)
R. Song, X. Chen, Y. Fang, H. Huang, Integrated navigation of GPS/INS based on fusion of recursive maximum likelihood IMM and square-root cubature Kalman filter. ISA Trans. 12(6), 387–395 (2020)
M. Sualeh, G.-W. Kim, Dynamic multi-lidar based multiple object detection and tracking. Sensors 19(6), 1474 (2019)
C.-H. Tseng, S.-F. Lin, D.-J. Jwo, Robust huber-based cubature Kalman filter for GPS navigation processing. J. Navig. 70(3), 527–546 (2017)
W. Wan, J. Feng, B. Song, X. Li, Huber-based robust unscented Kalman filter distributed drive electric vehicle state observation. Energies 14(3), 750 (2021)
X. Wang, N. Cui, J. Guo, Huber-based unscented filtering and its application to vision-based relative navigation. IET Radar Sonar Navig. 4(1), 134–141 (2010)
H. Wu, S.-X. Chen, B.-F. Yang, K. Chen, Robust cubature Kalman filter target tracking algorithm based on genernalized M-estiamtion. Acta. Phys. Sin. 64(21), 218401 (2015). https://doi.org/10.7498/aps.64.218401
M. Xu, X. Bu, H. Yang, Dual-band infrared and geomagnetic fusion attitude estimation algorithm based on IMMEKF. IEEE Trans. Ind. Electron. 68(11), 11286–11295 (2020)
Y. Yao, X. Xu, D. Yang, X. Xu, An IMM-UKF aided SINS/USBL calibration solution for underwater vehicles. IEEE Trans. Veh. Technol. 69(4), 3740–3747 (2020)
P. Yun, P. Wu, S. He, X. Li, Robust Kalman filter with fading factor under state transition model mismatch and outliers interference. Circ. Syst. Signal. Proc. 40(5), 2443–2463 (2021)
P. Yun, P. Wu, S. He, X. Li, A variational bayesian based robust cubature Kalman filter under dynamic model mismatch and outliers interference. Measurement 191, 110063 (2022)
D.H. Zhou, P.M. Frank, 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 (1996)
B. Zhu, L. Chang, J. Xu, F. Zha, J. Li, Huber-based adaptive unscented Kalman filter with non-gaussian measurement noise. Circ. Syst. Signal. Proc. 37(9), 3842–3861 (2018)
L. Zou, Z. Wang, H. Dong, Q.-L. Han, Energy-to-peak state estimation with intermittent measurement outliers: The single-output case (IEEE Trans, Cybern, 2021)
Acknowledgements
This work was supported by the Guangxi Innovation-driven Development Special Fund Project, China (Grant Nos. AA18242036; AA18242037), and the Zhaoqing University research fund project, China (No. QN202333).
Author information
Authors and Affiliations
Corresponding author
Ethics declarations
Conflict of interest
The authors declare that they have no conflicts of interest.
Additional information
Publisher's Note
Springer Nature remains neutral with regard to jurisdictional claims in published maps and institutional affiliations.
Rights and permissions
Springer Nature or its licensor (e.g. a society or other partner) holds exclusive rights to this article under a publishing agreement with the author(s) or other rightsholder(s); author self-archiving of the accepted manuscript version of this article is solely governed by the terms of such publishing agreement and applicable law.
About this article
Cite this article
Han, G., Liu, F., Deng, J. et al. An Adaptive Vehicle Tracking Enhancement Algorithm Based on Fuzzy Interacting Multiple Model Robust Cubature Kalman Filtering. Circuits Syst Signal Process 43, 191–223 (2024). https://doi.org/10.1007/s00034-023-02497-x
Received:
Revised:
Accepted:
Published:
Issue Date:
DOI: https://doi.org/10.1007/s00034-023-02497-x