SINS/DVL integrated based on interacting multiple model approach by integrating feedback particle filter for ship navigation

Abstract

To improve the performance of strapdown inertial navigation system (SINS)/ Doppler velocity logs (DVL) integrated navigation system, a new Interacting Multiple Model Feedback Particle Filter (IMMFPF) approach is proposed under the condition of complex and changeable underwater environment. In this scheme, the Interacting Multiple Model uses to deal with the model switch, while FPF approach takes each particle as a controllable stochastic system. By finding the solution about the Euler-Lagrange boundary value, the optimal feedback control law of Kullback-Leibler distance is obtained, and then the state of the particle itself is corrected and updated. Both simulations and field test illustrate that proposed IMMFPF approach can achieve a more accurate solution and make a more correct and effective response for SINS/DVL integrated navigation system.