A Novel Algorithm for SINS/CNS/GPS Integrated Navigation System

In this paper we present a novel algorithm for SINS(Strapdown Inertial Navigation)/CNS(Celestial Navigation System)/GPS(Global Positioning System) integrated navigation system. This novel algorithm is called as federated unscented particle filter(FUPF), and the SINS/CNS/GPS system models are nonlinear and non-Gaussian. This algorithm uses the UKF(Uscented Kalman Filter) to estimate the local filters, and the estimate results are employed to generate the importance proposal distributions of local filters. Then, the output of every local filter can be estimated from the importance proposal distributions by particle filter. Finally, this algorithm uses the federated filter method to fuse together the outputs from local UPF(Uscented Particle Filter) filters, and the final total estimation of the SINS/CNS/GPS system can be obtained. In this algorithm the particle filter incorporates the latest observations of local filters into a prior updating routine. In addition, the algorithm is not restricted by assumptions of linearity or Gaussian noise: it may be applied to any state transition or measurement model. Specifically, we apply the algorithm to maneuvering vehicles and simulation results show that the algorithm is more accurate than the federated UKF algorithm in the nonlinear and non-Gaussian models.