Adaptive H-infinite kalman filter based on multiple fading factors and its application in unmanned underwater vehicle

Aiming at the problem that the navigation performances of unmanned underwater vehicle (UUV) may be affected by inaccurate prior navigation information and external environmental interference, which may make the accuracy and reliability of strapdown inertial navigation system (SINS) and global position system (GPS) integrated navigation results worse, positioning divergent and system even invalid, an adaptive H-infinite kalman filtering algorithm based on multiple fading factors (MAHKF) is proposed in this paper. Firstly, the time-varying adaptive fading factor is used to modify the filter parameters on-line to make the initial error of navigation filter converge quickly. Secondly, the H-infinite kalman filter of the SINS/GPS system is built on combining the advantages of robust control, which improved the system robustness under extreme external environment. Further, the adaptive thresholdγ of the H-infinite kalman filter is introduced to make the filter adaptive to the environment change. Results of the simulation and experiment demonstrate that the initial error is converged at the beginning stage of navigation process, and the interference from external uncertainty inputs to the integrated navigation system are suppressed effectively with the proposed algorithm. Compared with the conventional kalman filter algorithm (KF), the position errors in three directions of the UUV are reduced by 66.57%,67.98% and 64.51% respectively with the proposed MAHKF.