Application of an unscented Kalman filter algorithm in the seabed terrain aided navigation

PAN Xiaohong,ZHAO Long
DOI: https://doi.org/10.3969/j.issn.1009-671X.201404012
2015-01-01
Abstract:In order to solve the problem that the linearization of the nonlinear process of the SITAN seabed terrain aided navigation algorithm is prone to instability and even the filtering divergence, a seabed terrain aided navigation algorithm based on unscented Kalman filter is proposed. This algorithm does not need nonlinear state and observa?tion equations to be linearized, directly using the unscented transform ( UT) to approximate probability density dis?tribution of nonlinear functions, and obtains the mean and variance of the transformed point set. It uses the seabed terrain SEAMAPnewHill100 as real terrain data to test this algorithm. The experimental results show that the algo?rithm is more precise and robust than the traditional algorithms.
What problem does this paper attempt to address?