A Fault-Tolerant Polar Grid SINS/DVL/USBL Integrated Navigation Algorithm Based on the Centralized Filter and Relative Position Measurement.

Navigation is a precondition for ocean space vehicles to work safely in polar regions. The traditional polar algorithms employ the grid strapdown inertial navigation system (SINS) as the backbone and Doppler velocity log (DVL) output velocity as measurements to constitute the integrated navigation system, of which, however, the position errors still accumulate with time. The ultra-short baseline (USBL) position system can provide position information that can be used to improve the performance of the SINS/DVL integrated system. Therefore, a grid SINS/DVL/USBL integrated algorithm for polar navigation is proposed in this paper. In order to extend the availability of the USBL and improve integration accuracy in polar regions, the USBL observation model is established based on the relative position measurement firstly. Then, a grid SINS/DVL/USBL integrated algorithm is proposed to fuse the information of these sensors with a modified Kalman filter (MKF) dealing with the sparse USBL output. Finally, a vector fault detection method, which takes the measurements as detection objects instead of the filter, is designed to locate the measurement fault and can be employed by the centralized filter to improve the fault-tolerant. Simulation and experiment results show that the proposed grid SINS/DVL/USBL integrated navigation system can further restrain SINS errors especially the position errors effectively. Meanwhile, the vector fault detection method can detect and isolate the fault measurements of centralized filter immediately and accurately. Therefore, the proposed fault-tolerant grid SINS/DVL/USBL integrated navigation algorithm can improve the reliability and accuracy of polar navigation for ocean space application.

A Novel Grid SINS/DVL Integrated Navigation Algorithm for Marine Application.

Integrated navigation algorithms under the grid frame have been proposed based on the Kalman filter (KF) to solve the problem of navigation in some special regions. However, in the existing study of grid strapdown inertial navigation system (SINS)/Doppler velocity log (DVL) integrated navigation algorithms, the Earth models of the filter dynamic model and the SINS mechanization are not unified. Besides, traditional integrated systems with the KF based correction scheme are susceptible to measurement errors, which would decrease the accuracy and robustness of the system. In this paper, an adaptive robust Kalman filter (ARKF) based hybrid-correction grid SINS/DVL integrated navigation algorithm is designed with the unified reference ellipsoid Earth model to improve the navigation accuracy in middle-high latitude regions for marine application. Firstly, to unify the Earth models, the mechanization of grid SINS is introduced and the error equations are derived based on the same reference ellipsoid Earth model. Then, a more accurate grid SINS/DVL filter model is designed according to the new error equations. Finally, a hybrid-correction scheme based on the ARKF is proposed to resist the effect of measurement errors. Simulation and experiment results show that, compared with the traditional algorithms, the proposed navigation algorithm can effectively improve the navigation performance in middle-high latitude regions by the unified Earth models and the ARKF based hybrid-correction scheme.

An Enhanced Non-Coherent Pre-Filter Design for Tracking Error Estimation in GNSS Receivers.

Tracking error estimation is of great importance in global navigation satellite system (GNSS) receivers. Any inaccurate estimation for tracking error will decrease the signal tracking ability of signal tracking loops and the accuracies of position fixing, velocity determination, and timing. Tracking error estimation can be done by traditional discriminator, or Kalman filter-based pre-filter. The pre-filter can be divided into two categories: coherent and non-coherent. This paper focuses on the performance improvements of non-coherent pre-filter. Firstly, the signal characteristics of coherent and non-coherent integration-which are the basis of tracking error estimation-are analyzed in detail. After that, the probability distribution of estimation noise of four-quadrant arctangent (ATAN2) discriminator is derived according to the mathematical model of coherent integration. Secondly, the statistical property of observation noise of non-coherent pre-filter is studied through Monte Carlo simulation to set the observation noise variance matrix correctly. Thirdly, a simple fault detection and exclusion (FDE) structure is introduced to the non-coherent pre-filter design, and thus its effective working range for carrier phase error estimation extends from (-0.25 cycle, 0.25 cycle) to (-0.5 cycle, 0.5 cycle). Finally, the estimation accuracies of discriminator, coherent pre-filter, and the enhanced non-coherent pre-filter are evaluated comprehensively through the carefully designed experiment scenario. The pre-filter outperforms traditional discriminator in estimation accuracy. In a highly dynamic scenario, the enhanced non-coherent pre-filter provides accuracy improvements of 41.6%, 46.4%, and 50.36% for carrier phase error, carrier frequency error, and code phase error estimation, respectively, when compared with coherent pre-filter. The enhanced non-coherent pre-filter outperforms the coherent pre-filter in code phase error estimation when carrier-to-noise density ratio is less than 28.8 dB-Hz, in carrier frequency error estimation when carrier-to-noise density ratio is less than 20 dB-Hz, and in carrier phase error estimation when carrier-to-noise density belongs to (15, 23) dB-Hz ∪ (26, 50) dB-Hz.