Optimization method of SINS/DVL tightly integrated navigation based on the ST-EKF under beam fault conditions

被引:0
作者
Ran C. [1 ,2 ]
Zhu Z. [3 ,4 ]
Wang W. [3 ,4 ]
Luo Z. [1 ,2 ]
Zhu Y. [5 ]
机构
[1] Hubei Engineering Research Center of Weak Magnetic-field Detection, China Three Gorges University, Yichang
[2] College of Science, China Three Gorges University, Yichang
[3] Hubei Key Laboratory of Intelligent Vision Monitoring for Hydroelectric Engineering, Yichang
[4] College of Computer and Information Technology, China Three Gorges University, Yichang
[5] School of Mechanical Engineering, Nantong University, Nantong
来源
Zhongguo Guanxing Jishu Xuebao/Journal of Chinese Inertial Technology | 2023年 / 31卷 / 10期
关键词
beam Doppler frequency shift reconstruction; particle swarm optimization; state transformation extend Kalman filter; strapdown inertial navigation system/Doppler velocity log tightly coupled navigation;
D O I
10.13695/j.cnki.12-1222/o3.2023.10.006
中图分类号
学科分类号
摘要
Aiming at the problem that when the beam fault occurs in the strapdown inertial navigation system/Doppler velocity log (SINS/DVL) tightly integrated navigation system based on extend Kalman filter (EKF), the fault processing scheme using beam frequency shift information reconstruction will cause the change of measurement noise characteristics and result in the reduction of navigation accuracy, an optimization method of SINS/DVL tightly integrated navigation based on state transformation extend Kalman filter (ST-EKF) under beam fault conditions is proposed. According to the structural characteristics of the four-beam Janus array, an objective function suitable for the tightly integrated navigation system is proposed, and the system noise covariance matrix and measurement noise covariance matrix are optimized by particle swarm optimization algorithm. The simulation results show that compared with the SINS/DVL tightly integrated navigation system based on EKF, the positioning accuracy of the proposed method is improved by 70.4%, which effectively improves the navigation accuracy of the integrated system under the condition of beam fault. © 2023 Editorial Department of Journal of Chinese Inertial Technology. All rights reserved.
引用
收藏
页码:996 / 1003
页数:7
相关论文
共 14 条
[1]  
Sahoo A, Dwivedy S K, Robi P S., Advancements in the field of autonomous underwater vehicle, Ocean Engineering, 181, pp. 145-160, (2019)
[2]  
Xu X, Gui J, Sun Y, Et al., A robust in-motion alignment method with inertial sensors and Doppler velocity log, IEEE Transactions on Instrumentation and Measurement, 70, pp. 1-13, (2021)
[3]  
Liang Z, Xie Y, Zhang Y, Et al., All-earth INS/DVL integrated navigation algorithm based on covariance transformation, Journal of Chinese Inertial Technology, 30, pp. 159-167, (2022)
[4]  
Wang M, Wu W, Zhou P, Et al., State transformation extended Kalman filter for GPS/SINS tightly coupled integration, GPS Solutions, 22, 4, pp. 1-12, (2018)
[5]  
Wang M, Wu W, He X, Et al., Further explanation and application of state transformation extended Kalman filter, Journal of Chinese Inertial Technology, 27, pp. 499-504, (2019)
[6]  
Zhao L, Liu X, Wang L, Et al., A pretreatment method for the velocity of DVL based on the motion constraint for the integrated SINS/DVL, Journal of Applied Sciences, 6, 3, pp. 79-93, (2016)
[7]  
Liu P, Wang B, Deng Z, Et al., INS/DVL/PS tightly coupled underwater navigation method with limited DVL measurements, IEEE Sensors Journal, 18, 8, pp. 2994-3002, (2018)
[8]  
Wang D, Xu X, Yao Y, Et al., A novel SINS/DVL tightly integrated navigation method for complex environment, IEEE Transactions on Instrumentation and Measurement, 69, 7, pp. 5183-5196, (2020)
[9]  
Ma X, Lu M, Zhang H, Et al., Algorithm of SINS/DVL integrated navigation based on echo beam, Journal of Chinese Inertial Technology, 29, pp. 164-170, (2021)
[10]  
Liu S, Zhang T, Zhang J, Et al., Study on SINS/DVL compact integrated navigation method based on Doppler frequency shift, Proceedings of the Symposium on Dynamic Development Direction of Inertial Technology -Integration and application of cutting-edge technology and inertial technology, pp. 116-124, (2021)