The invention relates to the technical field of
underwater acoustics and inertial navigation integrated navigation, in particular to a USBL
delay compensation method and
system based on selection state augmented information filtering, and the method comprises the steps: predicting an information matrix and an information vector at a current moment based on navigation state information vector
estimation and a navigation
state covariance information matrix at a previous moment; constructing an augmented information matrix of a
diagonal structure based on the augmented
state vector and obtaining an augmented information vector; and calculating a measurement information matrix and an information vector increment corresponding to each
delay measurement, and executing additive updating operation to construct a newly-added wide information matrix and a newly-added wide information vector with
delay measurement at the current moment so as to recover the navigation state at the current moment by utilizing a Schur compensation method. According to the method, the Markov characteristics of the
navigation system are utilized to construct the augmented information matrix with a block
diagonal structure, the sparsity of the matrix is fully mined, and the real-time performance and
numerical stability requirements of the
underwater navigation system are ensured by utilizing the advantages of information filtering in the aspect of measurement updating.