To address the problem of low accuracy for the regular filter algorithm in SINS/DVL integrated navigation, a square-root unscented information filter (SR-UIF) is presented in this paper. The proposed method: (1) adopts the state probability approximation instead of the Taylor model linearization in EKF algorithm to improve the accuracy of filtering estimation; (2) selects the most suitable parameter form at each filtering stage to simply the calculation complexity; (3) transforms the square root to ensure the symmetry and positive definiteness of the covariance matrix or information matrix, and then to enhance the stability of the filter. The simulation results indicate that the estimation accuracy of SR-UIF is higher than that of EKF, and similar to UKF; meanwhile the computational complexity of SR-UIF is lower than that of UKF.
The results show that the tracking accuracy of the integrated positioning system is much higher than that of the SINS alone REF .
Square-Root Unscented Information Filter and Its Application in SINS/DVL Integrated Navigation
Sensors (Basel, Switzerland)
Sensors (Basel, Switzerland)
Computer Science Engineering Medicine