SINS/DVL Integrated System With Current and Misalignment Estimation for Midwater Navigation

Motivated by the problem that water-track Doppler Velocity Log (DVL) cannot effectively suppress the error accumulation of strap-down inertial navigation system (SINS), this paper proposes a novel SINS/DVL integrated navigation algorithm for deep and long cruising range Human Occupied Vehicle (HOV). Such algorithm decomposes the navigation process into two tightly coupled working modes: alignment mode and navigation mode. In the alignment mode, HOV is controlled to perform horizontal circular motion for several minutes to realize Self-Aided SINS. Combining the precise navigation solutions provided by Self-Aided SINS and measurements from DVL with water track, recursive least square (RLS) algorithm is adopted to estimate heading misalignment angle between SINS and DVL and horizontal ocean current velocity. In the navigation mode, both horizontal ocean current velocity obtained in the alignment mode and DVL measurements are utilized to assist SINS, thus enabling SINS/DVL/Current integrated navigation. A square trajectory with a navigation-grade inertial measurement unit (IMU) is simulated to evaluate the proposed SINS/DVL integrated navigation algorithm. Simulation results show that the proposed SINS/DVL integrated navigation is capable of suppressing SINS error divergence effectively and efficiently. In addition, the feasibility and effectiveness of Self-Aided SINS based on horizontal circular motion is also verified by field test with real IMU data.