An improved federated filtering method for integrated navigation system of Autonomous Underwater Vehicle

Abstract

To improve the navigation accuracy of AUV (autonomous underwater vehicle), SINS (strapdown inertial navigation system), GPS (global positioning system), DVL (Doppler velocity log) and TAN (terrain aided navigation) are adopted in the AUV integrated navigation system. The mathematic model of the AUV integrated navigation system and the observation model of the chosen navigation sensors are built according to the system simulation experiments data. An improved filter based on RBF neural network for adjusting the information sharing factors is designed and implemented in the AUV integrated navigation system. Simulation experiments are carried out according to the mathematic model. It can be concluded from the simulation experiments that the navigation accuracy is improved substantially with the multiple sensors and federated filter in case that colored noise is engaged. The novel integrated navigation system is effective in prohibiting the divergence of the filter and improving fault tolerance ability and it greatly raises the precision of the navigation accuracy for the AUV integrated navigation system.