To address the problem of the bottom velocity being directly affected by the time-varying ocean currents when DVL operates in the water observation mode, it cannot be directly used for combined SINS/DVL navigation. Existing methods generally approximate small-scale, short-term currents as constant; however, this assumption is inconsistent with reality over longer durations. When the conventional Kalman filter (KF) algorithm incorporates currents into the state vector, their velocities become entangled with the SINS errors, limiting estimation accuracy. This paper proposes an augmented observation algorithm (AOA) that achieves error decoupling by enhancing DVL observation and deriving the observable current velocity equation without needing external observation information. This approach effectively estimates time-varying currents. The results from simulations and shipboard tests show that, compared to the reference algorithm (Augmented Observation Quantity Filtering algorithm (AOQ)), the proposed AOA significantly decreases the root mean square error (RMSE) of time-varying current velocity estimation by more than 67%. Additionally, the RMSE of the positioning accuracy of the combined SINS/DVL navigation is improved by over 68%.
In the platform gravimeter, the stabilization accuracy of the gravimetric stabilization platform is crucial to improve the accuracy of gravity value measurements due to its uncertainties, such as mechanical friction, inter-device coupling interference, and nonlinear disturbances. These cause fluctuations in the gravimetric stabilization platform system parameters and present nonlinear characteristics. To resolve the impact of the above problems on the control performance of the stabilization platform, an improved differential evolutionary adaptive fuzzy PID control (IDEAFC) algorithm is proposed. The proposed enhanced differential evolution algorithm is used to optimize the initial control parameters of the system adaptive fuzzy PID control algorithm to achieve accurate online adjustments of the gravimetric stabilization platform’s control parameters when it is subject to external disturbances or state changes and attain a high level of stabilization accuracy. The results of simulation tests, static stability experiments, and swaying experiments on the platform under laboratory conditions, as well as on-board experiments and shipboard experiments, all show that the improved differential evolution adaptive fuzzy PID control algorithm has a higher stability accuracy compared with the conventional control PID algorithm and traditional fuzzy control algorithm, proving the superiority, availability, and effectiveness of the algorithm.