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

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.

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.

Celestial navigation system (CNS) is a completely autonomous navigation technology with strong anti-interference ability and high navigation accuracy, which has a great application prospect. Aim at defect of traditional integrated navigation system using attitude angle measurement celestial navigation system and strapdown inertial navigation system (SINS), which can only correct of strapdown inertial navigation system’s gyro drift. This paper proposes an improved integrated navigation system that add double-star positioning celestial navigation to traditional SINS/CNS integrated navigation system, meanwhile, introduces the fault detection technology based on statistical distance to solve the problem that inaccuracy of measurement information leads to the integrated navigation system’s performance degradation. By analyzing the simulation results, the improved navigation system can inhibit divergence of system and obtain high accurate and stable navigation information.

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.

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.

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.

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.

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.

Unscented Kalman filter for SINS alignment

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.

Extended Kalman filter (EKF) is a widely used estimator for integrated navigation systems, and it works well in general situations. However, in adverse conditions such as partially observable environments and highly dynamic maneuvers, the performance of the traditional EKF-based strap-down inertial navigation system (SINS)/GPS integrated navigation system is easily to be affected by the dynamic changes of the specific force, thus leading to the problem of error covariance inconsistency. Though the inconsistency problem can be overcome to some extent if the system matrix, the states and the error covariance matrix are propagated as fast as possible in the SINS calculation rate, the problem cannot be fully solved. State transformation extended Kalman filter (ST-EKF) mechanization, with a new converted velocity error model for the SINS, is proposed, which can also be used to solve the inconsistency problem. In the ST-EKF, the specific force vector in the system error model is replaced by the nearly constant gravity vector for local navigation. Since the propagation and the updating of the ST-EKF can be executed simultaneously in the updating interval, the computation cost is greatly reduced compared with the traditional EKF. Experiments for the GPS/SINS tightly coupled navigation, including linear vibration Monte Carlo test and an unmanned aerial vehicle flight test, are implemented to evaluate the performance of the proposed ST-EKF. The results show that the proposed ST-EKF has superior performance to the traditional EKF, especially in partially observable situations.

With the rapid development of networking of vehicles, vehicle positioning problem gets more and more attention. GPS (Global Positioning System) and SINS (strapdown inertial navigation system) are the two technologies in the field of vehicle location. Although the GPS has a relatively high positioning accuracy, it can not get the positioning where satellites are blocked, which requires auxiliary of the other positioning means, to achieve AGPS (Assited Global Positioning System) positioning. SINS can get the vehicle driving parameters by IMU (Inertial Measurement Unit) in the case of no GPS signal and then make use of kinematics law to realize self-positioning. But due to error having a time cumulative, and the external device in the installation process, there is mounting error, and thus can not achieve a higher accuracy location. In order to solve this problem, this paper proposes a Dead reckoning system based on inertial devices to realize the autonomous positioning of the vehicle. The acceleration sensor is used to measure the acceleration of the carrier, and the gyro sensor is used to measure the yaw angle of the vehicle. DR algorithm is used to calculate the approximate position of the vehicle, and the error factor of GPS acquisition is used to correct the vehicle trajectory. In this paper, through the simulation analysis, it is verified that the real-time correction eliminates the error, effectively improves the positioning accuracy, and meets the positioning and navigation requirements of the blind area of GPS signal.

The strap-down inertial navigation system (SINS), especially the SINS composed by dithered ring laser gyroscope (DRLG) is a kind of equipment, which providing high reliability and performance for moving vehicles. However, the mechanical dither which is used to eliminate the “Lock-In” effect can cause vibration disturbance to the INS and lead to dithering coupling problem in the inertial measurement unit (IMU) gyroscope triad, so its further application is limited. Among DRLG errors between the true gyro rotation rate and the measured rotation rate, the frequently considered one is the input axis misalignment between input reference axis which is perpendicular to the mounting surface and gyro angular rate input axis. But the misalignment angle between DRLG dither axis and gyro angular rate input axis is often ignored by researchers, which is amplified by dither coupling problem and that would lead to negative effects especially in high accuracy SINS. In order to study the problem more clearly, the concept of misalignment between DRLG dither axis and gyro angle rate input axis is researched. Considering the error of misalignment is of the order of 10 -3 rad. or even smaller, the best way to measure it is using DRLG itself by means of an angle exciter as an auxiliary. In this paper, the concept of dither axis misalignment is explained explicitly firstly, based on this, the frequency of angle exciter is induced as reference parameter, when DRLG is mounted on the angle exciter in a certain angle, the projections of angle exciter rotation rate and mechanical oscillation rate on the gyro input axis are both sensed by DRLG. If the dither axis has misalignment error with the gyro input axis, there will be four major frequencies detected: the frequency of angle exciter, the dither mechanical frequency, sum and difference frequencies of the former two frequencies. Then the amplitude spectrum of DRLG output signal obtained by the using LabVIEW program. if there are only angle exciter and the dither mechanical frequencies, the misalignment may be too small to be detected, otherwise, the amplitude of the sum and difference frequencies will show the misalignment angle between the gyro angle rate input axis and the dither axis. Finally, some related parameters such as frequency and amplitude of the angle exciter and sample rate are calculated and the results are analyzed. The simulation and experiment result prove the effectiveness of the proposed method..