SINS/DVL integrated based on interacting multiple model approach by integrating feedback particle filter for ship navigation

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.

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.

In order to improve the positioning accuracy of two leader autonomous underwater vehicles (AUVs) in underwater cooperative navigation formation, a decentralized cooperative localization algorithm based on adaptive cubature Kalman filter (ACKF-DCL) for strapdown inertial navigation system (SINS)/Doppler velocity log (DVL) integrated navigation system is proposed. Firstly, the kinematic equations of the SINS are used to establish the direct filtering approach model for integrated navigation. Secondly, the Sage-Husa adaptive filtering algorithm and the sequential Kalman filtering (SKF) method are introduced into the nonlinear cubature Kalman filter (CKF) to adjust adaptively the measurement noise and maintain the positivity of the covariance matrix. Finally, the cross-correlation covariance between two AUVs is derived according to the characteristics of a decentralized data structure, so as to track the inter-AUV dependencies. And the acoustic ranging measurement is introduced to achieve relative measurement update. The lake trial demonstrates the proposed algorithm’s effectiveness and superiority, and the results show that the algorithm can effectively track the measurement noise covariance matrix and improve the positioning accuracy of both AUVs by position correction.

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.

As the exploration of marine resources continues to deepen, the utilization of Autonomous Underwater Vehicles (AUVs) for conducting marine resource surveys and underwater environmental mapping has become a common practice. In order to successfully accomplish exploration missions, AUVs require high-precision underwater navigation information as support. A Strapdown Inertial Navigation System (SINS) can provide AUVs with accurate attitude and heading information, while a Doppler Velocity Log (DVL) is capable of measuring the velocity vector of the AUVs. Therefore, the integrated SINS/DVL navigation system can furnish the necessary navigational information required by an AUV. In response to the issue of DVL being susceptible to external environmental interference, leading to reduced measurement accuracy, this paper proposes an end-to-end deep-learning approach to enhance the accuracy of DVL velocity vector measurements. The utilization of the raw measurement data from an Inertial Measurement Unit (IMU), which includes gyroscopes and accelerometers, to assist the DVL in velocity vector estimation and to refine it towards the Global Positioning System (GPS) velocity vector, compensates for the external environmental interference affecting the DVL, therefore enhancing the navigation accuracy. To evaluate the proposed method, we conducted lake experiments using SINS and DVL equipment, from which the collected data were organized into a dataset for training and assessing the model. The research results show that the DVL vector predicted by our model can achieve a maximum improvement of 69.26% in terms of root mean square error and a maximum improvement of 78.62% in terms of relative trajectory error.

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.

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.

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.

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

Aiming at the situation that the underwater integrated navigation system is easy to be disturbed and the output is unavailable during the task of underwater vehicle, a RVBAKF/ LSTM hybrid method is proposed in this paper. Considering the actual underwater working environment of autonomous underwater vehicles (AUV), the measured value of Doppler velocity log (DVL) is prone to outliers or even interruption, so it is very important to improve the fault tolerance of integrated navigation system. For the processing of outliers, a robust adaptive filter based on VB theory is proposed. Its advantage is to realize the adaptation of time-varying noise and reduce the interference of outliers to the integrated navigation system. Firstly, selecting the SINS output related to AUV velocity, such as velocity, attitude, angular velocity and specific force as the training input when the DVL output is normal. When DVL output is interrupted, the long short-term memory (LSTM) model is used to provide pseudo measurement values for integrated navigation system. The effectiveness of the method is verified by the on-board experimental data. When the DVL output is interrupted, the method can effectively improve the accuracy of the integrated navigation system. The method in this paper is compared with four different hybrid methods, and the results are obviously better than the four methods.

The extended Kalman filter (EKF) as a primary integration scheme has been applied in the Global Positioning System (GPS) and inertial navigation system (INS) integrated system. Nevertheless, the inherent drawbacks of EKF contain not only instability caused by linearization, but also massive calculation of Jacobian matrix. To cope with this problem, the adaptive interacting multiple model (AIMM) filter method is proposed to enhance navigation performance. The soft-switching characteristic, which is provided by interacting multiple model algorithm, permits process noise to be converted between upper and lower limits, and the measurement covariance is regulated by Sage adaptive filtering on-line Moreover, since the pseudo-range and Doppler observations need to be updated, an updating policy for classified measurement is considered. Finally, the performance of the GPS/INS integration method on the basis of AIMM is evaluated by a real ship, and comparison results demonstrate that AIMM could achieve a more position accuracy.

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.

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 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.

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.