Improved SINS/CNS Integrated Navigation System with Fault Detection Based on Statistical Distance

In this paper, we investigate the problem of autonomous integrated navigation of strapdown inertial navigation system (SINS)/ celestial navigation system (CNS) for a ballistic missile. To handle the nonlinear missile dynamic model, three filtering methods including extended Kalman filter (EKF), extended Kalman particle filter (EKPF) and unscented particle filter (UPF) are utilized to fusion the integrated navigation system and improve the navigation accuracy. The performance of the navigation system based on the three methods is analyzed and compared. Simulation results indicate that the UPF can provide the highest navigation accuracy with the price of highest computation burden.

SINS/ANS integration for augmented performance navigation solution using unscented Kalman filtering

The fusion of multi-sensor data can provide more accurate and reliable navigation performance than single-sensor methods. However, the general Federated Kalman Filter (FKF) is not suitable for large changes of complex nonlinear systems parameters and is not optimized for effective information sharing coefficients to estimate navigation preferences. This study concerns research on the FKF method for a nonlinear adaptive model based on an improved Genetic Algorithm (GA) for the Strapdown Inertial Navigation System (SINS) / Celestial Navigation System (CNS) / Global Positioning System (GPS) integrated multi-sensor navigation system. An improved fitness function avoids the premature convergence problem of a general GA and decimal coding improves its performance. The improved GA is used to build the adaptive FKF model and to select the optimized information sharing coefficients of the FKF. An Unscented Kalman Filter (UKF) is used to deal with the nonlinearity of integrated navigation system. Finally, a solution and implementation of the system is proposed and verified experimentally.

To solve the problem of information fusion in the strapdown inertial navigation system (SINS)/celestial navigation system (CNS)/global positioning system (GPS) integrated navigation system described by the nonlinear/non-Gaussian error models, a new algorithm called the federated unscented particle filtering (FUPF) algorithm was introduced. In this algorithm, the unscented particle filter (UPF) served as the local filter, the federated filter was used to fuse outputs of all local filters, and the global filter result was obtained. Because the algorithm was not confined to the assumption of Gaussian noise, it was of great significance to integrated navigation systems described by the non-Gaussian noise. The proposed algorithm was tested in a vehicle’s maneuvering trajectory, which included six flight phases: climbing, level flight, left turning, level flight, right turning and level flight. Simulation results are presented to demonstrate the improved performance of the FUPF over conventional federated unscented Kalman filter (FUKF). For instance, the mean of position-error decreases from (0.640×10−6 rad, 0.667×10−6 rad, 4.25 m) of FUKF to (0.403×10−6 rad, 0.251×10−6 rad, 1.36 m) of FUPF. In comparison of the FUKF, the FUPF performs more accurate in the SINS/CNS/GPS system described by the nonlinear/non-Gaussian error models.

In the integrated inertial navigation system (INS) and celestial navigation system (CNS), the attitudes and positions of probes are estimated based on the auxiliary measurement of an infrared Earth sensor. The poor accuracy of the infrared Earth sensor compared to that of the star sensor significantly limits the navigation accuracy of the integrated navigation system. This paper proposes a novel INS/CNS integrated navigation system that uses the specific force with noncumulative error to correct infrared Earth measurements. The probe azimuth angle and elevation angle relative to the Earth's inertial frame are first estimated according to the specific force provided by the INS to filter the infrared Earth sensor's measurement error. Then, the corrected infrared Earth measurement assists the CNS to obtain accurate celestial measurements. The integrated INS/CNS navigation system in the tightly coupled mode finally estimates the accurate probe attitude and position. Compared to the integrated navigation system, which directly uses the uncorrected infrared Earth measurement, the yaw, pitch, and roll angle are improved under the proposed method by 76.73%, 77.64%, and 75.39% on average, respectively; the latitude and longitude estimation errors improve under the proposed method by 70.44% and 61.92% on average, respectively. In short, the proposed method is a feasible and highly accurate approach to the INS/CNS integrated navigation system.

High dynamic aircraft is a very attractive new generation vehicles, in which provides near space aviation with large flight envelope both speed and altitude, for example the hypersonic vehicles. The complex flight environments for high dynamic vehicles require high accuracy and stability navigation scheme. Since the conventional Strapdown Inertial Navigation System (SINS) and Global Position System (GPS) federal integrated scheme based on EKF (Extended Kalman Filter) is invalidation in GPS single blackout situation because of high speed flight, a new high precision and stability integrated navigation approach is presented in this paper, in which the SINS, GPS and Celestial Navigation System (CNS) is combined as a federal information fusion configuration based on nonlinear Unscented Kalman Filter (UKF) algorithm. Firstly, the new integrated system state error is modeled. According to this error model, the SINS system is used as the navigation solution mathematic platform. The SINS combine with GPS constitute one error estimation filter subsystem based on UKF to obtain local optimal estimation, and the SINS combine with CNS constitute another error estimation subsystem. A non-reset federated configuration filter based on partial information is proposed to fuse two local optimal estimations to get global optimal error estimation, and the global optimal estimation is used to correct the SINS navigation solution. The χ 2 fault detection method is used to detect the subsystem fault, and the fault subsystem is isolation through fault interval to protect system away from the divergence. The integrated system takes advantages of SINS, GPS and CNS to an immense improvement for high accuracy and reliably high dynamic navigation application. Simulation result shows that federated fusion of using GPS and CNS to revise SINS solution is reasonable and availably with good estimation performance, which are satisfied with the demands of high dynamic flight navigation. The UKF is superior than EKF based integrated scheme, in which has smaller estimation error and quickly convergence rate.

To improve the navigation accuracy of AUV (autonomous underwater vehicle), SINS (strapdown inertial navigation system), GPS (global positioning system), DVL (Doppler velocity log) and TAN (terrain aided navigation) are adopted in the AUV integrated navigation system. The mathematic model of the AUV integrated navigation system and the observation model of the chosen navigation sensors are built according to the system simulation experiments data. An improved filter based on RBF neural network for adjusting the information sharing factors is designed and implemented in the AUV integrated navigation system. Simulation experiments are carried out according to the mathematic model. It can be concluded from the simulation experiments that the navigation accuracy is improved substantially with the multiple sensors and federated filter in case that colored noise is engaged. The novel integrated navigation system is effective in prohibiting the divergence of the filter and improving fault tolerance ability and it greatly raises the precision of the navigation accuracy for the AUV integrated navigation system.

There are the scale factor error of LDV (laser Doppler velocimeter) and the misalignment between the SINS (Strapdown inertial navigation system) and the vehicle in a SINS/LDV integrated navigation system. In this paper, the effects of these errors on the attitude, velocity and position of dead reckoning are derived, and a new online calibration method aiming to calibrate the scale factor of LDV and the misalignment between the SINS and the vehicle for the integrated system is put forward. This method, which is utilize the velocity and position of the Global Position System (GPS) as references, use the velocity error and position error of dead reckoning to estimate these errors. Through simulation and experiment, the validity and feasibility of the method are verified. The results show that the scale factor and the misalignment can be calibrated with satisfying accuracy, and the related research can provide technical support for high precision navigation of SINS/LDV integrated navigation systems.

The integrated navigation system of strapdown inertial navigation system (SINS) and odometer (OD) is a commonly used vehicle positioning system. The installation errors caused by the difference between the installation positions of SINS and OD mainly include the installation deflection angle and lever arm, which will reduce the positioning accuracy. The traditional calibration method is to expand the installation deflection angle error and lever arm error into state variables, the velocity difference under nonholonomic constraint (NHC) is taken as the measurement to establish the Kalman filter model for online calibration, but this method seriously depends on the sensor accuracy. In order to calibrate the installation errors of low-precision SINS, this paper improves NHC, adds the difference between the centripetal acceleration measured by odometer and calculated by SINS as measurement on the basis of the original measurement, and introduces a low-pass filter to reduce the interference of vehicle vibration on the accelerometer.The experimental results show that the proposed algorithm has better convergence of the installation deflection angle, and the error between the estimation results of the forward lever arm and the actual measurement results is less than 0.1m; After compensating the installation errors of the improved NHC, the maximum positioning errors in the east and north directions are reduced by 63.19% and 43.51% respectively, the height error is also greatly reduced, and the positioning accuracy of the integrated navigation system is significantly improved.

Due to the influence of the complex underwater environment, the initial alignment method for Doppler velocity log (DVL)-aided strap-down inertial navigation systems (SINS) often suffer from performance degradation, especially when DVL measurements are contaminated by outliers. In this paper, an outlier-resistant Initial Alignment method with interference suppression for SINS/DVL integrated navigation system is proposed, by which, by constructing an improved Mahalanobis distance anomalous detection criterion, the anomaly of the residual vector composed of observation vectors is judged, and an adaptive weighting factor is introduced into the observation matrix to suppress the abnormal interference in the alignment process. Simulation and experimental results show that, compared with existing initial alignment methods, the proposed method achieves higher alignment accuracy in the presence of outliers, which is more suitable for the SINS/DVL integrated navigation system.

The asynchronous fusion method is the key technology of multi-sensor integrated navigation system which is independently observed by multiple auxiliary navigation sensors with different data output rates. The multi-scale asynchronous fusion can effectively increase the accuracy of integrated navigation system, but the existing multi-scale asynchronous fusion algorithm has the characteristic of heavy computational burden and requires the data output rates of auxiliary navigation sensors to meet unrealistic special requirements. To solve this problem, a multi-scale asynchronous fusion algorithm for the multi-sensor integrated navigation system is presented based on state block vector and wavelet transform. This algorithm first converts the system’s original state equation into the relationship between the state block vector and the state point vector to obtain the state equation of the multi-scale dynamic system, and expresses the original measurement equation as the relationship with the state block vector to obtain the measurement equation of the multi-scale dynamic system. Then, the special implementation process of this algorithm is studied and expressed in details, on the basis of the matrix operator with scale and wavelet property. Finally, a multi-sensor integrated navigation system composed of strapdown inertial navigation system, celestial navigation system, global navigation satellite system, and air data system is designed and experimented validation analysis. Experiment results show that this algorithm can significantly reduce the average root mean square error and improve the accuracy of navigation parameters, compared with asynchronous preprocessing Kalman filter and asynchronous direct Kalman filter. It would have a wide prospect in multi-sensor integrated navigation systems.

SINS (Strap-down Inertial Navigation System) and GPS (Global positioning system) integrated navigation system has been extensively applied in many areas. In-flight alignment (IFA) is one of the key technologies. In this paper, an iterative unscented Kalman filter (IUKF) for SINS/GPS integrated navigation system is proposed to achieve IFA approach. Firstly, the nonlinear error equation of SINS is established, and the difference between the position and velocity of the two navigation systems is taken as the observation variables. Then, an IUKF is proposed to minimize the truncation error caused by Taylor expansion and reduce the influence of initial state value on the system state. Finally, simulation results can prove that the IUKF improves the navigation precision and robustness of system compared with the counterpart of UKF.KeywordsIntegrated navigation systemIterative filterIn-flight alignment

The constraints of weight, volume and power for Small unmanned air vehicle (UAV) restrict the application of sensors with heavy and good performance and powerful processors. This paper presents a real-time solution of autonomous flight navigation and its results for small UAV by applying small, cheap, low precision and low-power integrated navigation system, which includes Strap-down Inertial Navigation System (SINS) based on Micro-electro-mechanical system (MEMS) inertial sensors, Global Positioning System (GPS) receiver and magnetometer. The Square-Root Unscented Kalman filter (SR-UKF) for data fusion using in this MEMS-SINS/GPS/ magnetometer integrated navigation system provides continuous and reliable navigation results for the loops of guidance and control for the small UAV with autonomous flight. The whole integrated navigation system algorithm is implemented within low-power embedded microprocessors. The real-time flight test results show that the MEMS-SINS/GPS/magnetometer integrated navigation system is effective and accurate.

With the advantages of high velocity measurement accuracy and fast dynamic response, the laser Doppler velocimeter (LDV) is expected to replace the odometer to be combined with a strapdown inertial navigation system (SINS) to form a higher precision integrated navigation system. However, LDV scale factor error and misalignment angles between LDV and inertial measurement unit will affect the accuracy of navigation. Considering that not all global navigation satellite system (GNSS) receivers can directly provide velocity information and current mainstream calibration methods are sensitive to the measurement noise and outliers of velocity and position information, a robust calibration method aided by GNSS is proposed in this paper, which is based on position observation. Different from current popular calibration methods, the attitude information of the GNSS/SINS integrated navigation system obtained by an adaptive Kalman filter is used to construct the observation vector together with LDV velocity outputs and GNSS position outputs in this method. The LDV scale factor error and the misalignment angle are determined by the ratio of two observation vector modulus and the Davenport's q-method method, respectively. The accuracy and robustness of the calibration method are verified by one vehicle test with normal GNSS signals and one vehicle test with GNSS signals with outliers. And the horizontal position error of dead reckoning of the calibrated LDV/SINS integrated system are less than 0.0314% and 0.1033% of the mileage, respectively.

The extended Kalman filter (EKF) has been used widely in Global Position System (GPS) and Strapdown Inertial Navigation Systems (SINS) integrated navigation systems,which simply linearizes all nonlinear models.However, careful treatment of the nonlinearity of the system models is particularly critical when the integrated systems use low cost micro-electro-mechanical (MEMS) inertial sensors. Hence application of the EKF in MEMS inertial sensor-based integrated navigation systems will likely lead to inaccurate results. To overcome the shortcomings of the EKF, the unscented Kalman filter (UKF) has been proposed.The UKF does not require the linearization of the system models. Alternatively it uses a set of deterministically selected "sigma-points",which completely capture the true mean and covariance of the original random vector. Then these sigma-points are propagated through the nonlinear models.This captures the mean and covariance to second order accuracy for arbitrary nonlinear functions. In this paper the EKF and UKF are applied in GPS/SINS integrated systems respectively. Simulation result demonstrates that the performance of the UKF is better than the EKF in MEMS inertial sensor-based SINS/GPS integrated systems.