We proposed an adaptive H-infinity Cubature Kalman Filter (AH∞CKF) to improve the navigation accuracy of a highly manoeuvrable unmanned aerial vehicle (UAV). AH∞CKF fuses the Inertial Navigation System (INS) and Global Navigation Satellite System (GNSS) measurements. Traditional state estimation filters like extended Kalman filters (EKF) and cubature Kalman filters (CKF) assume Gaussian noises. However, their performance degrades for non-Gaussian noises and system uncertainties encountered in real-world applications. Thus, designing filters robust to noise and distribution is crucial. AH∞CKF combines H∞CKF design with an added adaptive factor to adjust the state estimation covariance matrix according to measurements by exploiting the square root method to yield more numerically stable results (SrAH∞CKF). We conducted multiple dynamically rich flight tests to validate our claims using a UAV equipped with a commercially well-known GNSS solution. Results show that the SrAH∞CKF state estimation outperforms EKF and CKF methods on average by 90% in various statistical measures.

This paper presents a hybrid unscented particle filter (UPF) based on the firefly algorithm for tightly-coupled stereo visual-inertial vehicle positioning systems (VIVPS). Compared with standard UPF, this novel approach can achieve similar estimation accuracy with much less computational complexity. To reduce the computational complexity, the time updating of the hybrid unscented Kalman filter is conducted via the formula of standard linear Kalman filter on the basis of the constructed linear/nonlinear mixed filter model. The particle updating of the particle filter is optimised by modified firefly algorithm to reduce the number of particles needed by means of moving particles towards high likelihood regions via the attraction and movement of fireflies, leading to a significant reduction of computational complexity. Experimental results show the average execution time of the proposed approach is 23·8% that of the standard UPF with similar accuracy, indicating the designed method for tightly-coupled stereo VIVPS can better satisfy the real-time requirement of the system.

This paper proposes a simplified algorithm for reducing the computational load of the conventional underwater integrated navigation system. The system usually comprises a three-dimensional accelerometer, a three-dimensional gyroscope, a three-dimensional Doppler Velocity Log (DVL) and a data fusion algorithm, such as a Kalman Filter (KF). Since the expected variations of roll, pitch and depth are small, these quantities are assumed to be constant, and the proposed system is designed in a two-dimensional form. Due to the low speed of the vehicle, the nonlinear dynamic equation of the velocity can be simplified in a linear form. We also simplify the conventional KF in order to avoid matrix multiplications and matrix inversions. The performance of the designed system is evaluated in a sea trial by an Autonomous Underwater Vehicle (AUV). The results show that the proposed system can significantly reduce the computational load of the conventional integrated navigation system without a significant reduction in position and velocity accuracy.

For the integrated navigation system, the correctness and the rapidity of fault detection for each sensor subsystem affects the accuracy of navigation. In this paper, a novel fault detection method for navigation systems is proposed based on Gaussian Process Regression (GPR). A GPR model is first used to predict the innovation of a Kalman filter. To avoid local optimisation, particle swarm optimisation is adopted to find the optimal hyper-parameters for the GPR model. The Fault Detection Function (FDF), which has an obvious jump in value when a fault occurs, is composed of the predicted innovation, the actual innovation of the Kalman filter and their variance. The fault can be detected by comparing the FDF value with a predefined threshold. In order to verify its validity, the proposed method is used in a SINS/GPS/Odometer integrated navigation system. The comparison experiments confirm that the proposed method can detect a gradual fault more quickly compared with the residual chi-squared test. Thus the navigation system with the proposed method gives more accurate outputs and its reliability is greatly improved.

A new nonlinear robust filter is proposed in this paper to deal with the outliers of an integrated Global Positioning System/Strapdown Inertial Navigation System (GPS/SINS) navigation system. The influence of different design parameters for an H∞ cubature Kalman filter is analysed. It is found that when the design parameter is small, the robustness of the filter is stronger. However, the design parameter is easily out of step in the Riccati equation and the filter easily diverges. In this respect, a singular value decomposition algorithm is employed to replace the Cholesky decomposition in the robust cubature Kalman filter. With large conditions for the design parameter, the new filter is more robust. The test results demonstrate that the proposed filter algorithm is more reliable and effective in dealing with the outliers in the data sets produced by the integrated GPS/SINS system.