INS/gravity gradient aided navigation based on gravitation field particle filter

Abstract

Swarm intelligence method is an effective way to improve the particle degradation and sample depletion of the traditional particle filter. This paper proposes a particle filer based on the gravitation field algorithm (GF-PF), and the gravitation field algorithm is introduced into the resampling process to improve particle degradation and sample depletion. The gravitation field algorithm simulates the solar nebular disk model, and introduces the virtual central attractive force and virtual rotation repulsion force between particles. The particles are moves rapidly to the high-likelihood region under action of the virtual central attractive force. The virtual rotation repulsion force makes the particles keep a certain distance from each other. These operations improve estimation performance, avoid overlapping of particles and maintain the diversity of particles. The proposed method is applied into INS/gravity gradient aided navigation, by combining the sea experimental data of an inertial navigation system. Compared with the particle swarm optimization particle filter(PSO-PF) and artificial physics optimized particle filter (APO-PF), the GF-PF has higher position estimate accuracy and faster convergence speed with the same experimental conditions.