The strap-down inertial navigation system (SINS) and Doppler velocity log (DVL) integrated navigation system are widely used for autonomous underwater vehicles (AUVs). Whereas DVL works in the water tracking mode, the velocity provided by DVL is relative to the current layer and cannot be directly used to suppress the divergence of SINS errors. Therefore, the estimation and compensation of the ocean current velocity play an essential role in improving navigation positioning accuracy. In recent works, ocean currents are considered constant over a short term in small areas. In the common KF algorithm with the ocean current as a state vector, the current velocity cannot be estimated because the current velocity and the SINS velocity error are coupled. In this paper, two virtual metrology filter (VMF) methods are proposed for estimating the velocity of ocean currents based on the properties that the currents remain unchanged at the adjacent moments. New measurement equations are constructed to decouple the current velocity and the SINS velocity error, respectively. Simulations and lake tests show that both proposed methods are effective in estimating the current velocity, and each has its advantages in estimating the ocean current velocity or the misalignment angle.
Read full abstract