Abstract
In underwater acoustic long baseline navigation, the motion state of underwater vehicle is changeable and there are abnormal observations, which reduces the navigation accuracy of traditional filtering algorithm and cannot meet the demand of high precision underwater navigation. To solve this problem, this paper proposes an improved robust interacting multiple model algorithm. Firstly, the robust estimation of each model is carried out, and the equivalent variance and model probability of each model are obtained. The weight of equivalent variance is determined according to the model probability, and the mixed equivalent variance is obtained by weighted summation of equivalent variance. The mixed equivalent variance is used to replace the measurement noise variance in each model for state estimation, and the interacting robust estimation is realized. Then the model probability is updated, and the power function with faster growth rate is used to replace the matching model probability to realize the model probability correction. Finally, the final state estimation value and its covariance matrix are obtained by weighted summation of the results of the interacting robust estimation of each model according to the revised model probability, so as to improve the navigation accuracy and stability of underwater vehicles. By processing simulation and measured data, the results show that compared with Kalman filter, interactive multi-model and robust interactive multi-model, in the simulation data, the navigation error of the proposed method is reduced by 64.18%, 26.35% and 10.61%, respectively; in the measured data, the navigation accuracy of this method is improved by 31.79%, 14.76% and 14.93% respectively, and the navigation accuracy reaches 3.7687 m in 3 km × 3 km. Compared with the traditional filtering algorithm, the improved robust interacting multiple model algorithm can significantly improve the navigation accuracy and stability of underwater vehicles.
Access this chapter
Tax calculation will be finalised at checkout
Purchases are for personal use only
Similar content being viewed by others
References
Sun, D., Zheng, C.: Study on the development trend of underwater acoustic navigation and positioning technologies. J. Ocean Technol. 34(03), 64–68 (2015)
Sun, D., Zheng, C., Qian, H., Li, Z.: The application of underwater acoustic positioning systems in ocean engineering. Tech. Acoust. 31(02), 125–132 (2012)
Liu, Y., Xu, T., Wang, J., Mu, D.: Multibeam seafloor topography distortion correction based on SVP inversion. J. Mar. Sci. Technol. 1–15 (2021). https://doi.org/10.1007/s00773-021-00845-7
Yang, Y., Xu, T., Xue, S.: Progresses and prospects in developing marine geodetic datum and marine navigation of China. Acta Geodaetica et Cartographica Sinica 46(01), 1–8 (2017)
Wang, J., Xu, T., Wang, Z.: Adaptive robust unscented Kalman filter for AUV acoustic navigation. Sensors 20(1), 60 (2019)
Guo, Y.: Research and software implementation of long baseline navigation optimization algorithm. Master, Harbin Engineering University (2019)
Wang, J.: Research on nonlinear filtering algorithm for underwater AUV navigation. Master, China University of Petroleum (East China) (2018)
Dx, J., Ray, J.L.: Theory application in long baseline system. China Ocean Eng. 24(1), 199–206 (2010)
Kalman, R.E.: New results in linear filtering and prediction theory. Transasme Serdjbasic Eng. 83, 95–108 (1961)
Yang, Y., He, H., Xu, T.: Adaptive robust filtering for kinematic GPS positioning. Acta Geodaetica et Cartographica Sinica 30(4), 6 (2001)
Lu, S.: The research of adaptive robust filtering for multi-AUV cooperative navigation. Master, Harbin Engineering University (2016)
Wang, J., Xu, T., Zhang, B., Nie, W.: Underwater acoustic positioning based on the robust zero-difference Kalman filter. J. Mar. Sci. Technol. 26(3), 734–749 (2020). https://doi.org/10.1007/s00773-020-00766-x
Huber, P.J.: Robust estimation of a location parameter. Ann. Math. Stat. 35(1), 73–101 (1964)
Zhang, Q.: Advanced Theory and Application of Surveying Data. Surveying and Mapping Press, Beijing (2011)
Yang, Y.: Adaptive Navigation and Kinematic Positioning. Surveying and Mapping Press, Beijing (2006)
Blom, H.A.P., Bar-Shalom, Y.: The interacting multiple model algorithm for systems with Markovian switching coefficients. IEEE Trans. Autom. Control 33(8), 780–783 (1988)
Bing, Z.A., Hh, B.: Integrated navigation for doppler velocity log aided strapdown inertial navigation system based on robust IMM algorithm. Optik 217, 164871 (2020)
Liu, X., Liu, X., Zhang, W., Yang, Y.: Interacting multiple model UAV navigation algorithm based on a robust cubature Kalman filter. IEEE Access 8, 81034–81044 (2020)
Yang, Y., Wu, F.: Modified equivalent weight function with variable criterion. J. Zhengzhou Inst. Surveying Mapp. 23(05), 317–320+24 (2006)
Acknowledgements
The study is funded by National Key Research and Development Program of China (2020YFB0505800 and 2020YFB0505804), Wenhai Program of the S&T Fund of Shandong Province for Pilot National Laboratory for Marine Science and Technology (Qingdao) (NO. 2021WHZZB1004), Open foundation of State Key Laboratory of Geo-information Engineering (SKLGIE2019-Z-2-2), Foundation of Key Laboratory of Marine Environmental Survey Technology and Application, Ministry of Natural Resources, China (MESTA-2020-B013).
Author information
Authors and Affiliations
Corresponding author
Editor information
Editors and Affiliations
Rights and permissions
Copyright information
© 2022 Aerospace Information Research Institute
About this paper
Cite this paper
Shu, J., Xu, T., Wang, J., Liu, Y., Li, M. (2022). An Improved Robust Interacting Multiple Model Algorithm for Underwater Acoustic Navigation. In: Yang, C., Xie, J. (eds) China Satellite Navigation Conference (CSNC 2022) Proceedings. Lecture Notes in Electrical Engineering, vol 910. Springer, Singapore. https://doi.org/10.1007/978-981-19-2576-4_45
Download citation
DOI: https://doi.org/10.1007/978-981-19-2576-4_45
Published:
Publisher Name: Springer, Singapore
Print ISBN: 978-981-19-2575-7
Online ISBN: 978-981-19-2576-4
eBook Packages: EngineeringEngineering (R0)