A Robust Interactive Multiple Model (RIMM) algorithm with the adaptive model set is proposed to improve the performance of Inertial Navigation System (INS) and Doppler Velocity Logs (DVL) integrated navigation system under complex measurement environment with undesirable heavy-tailed non-Gaussian noise. Specifically, an improved Huber kernel function is applied to the robust error state Kalman filter (ESKF) for its benefit of better resisting larger measurement outliers. In addition, a flexible adaptive model set update strategy is proposed where the model set is determined by the current and historical measurement information stored in the sliding window. And for model set update, the main model is no longer fixed, it will be determined based on the probability weights corresponding to each model. This innovative RIMM algorithm is compared with error state Kalman filter, Interactive Multiple Model (IMM) and Hybrid Interactive Multiple Model (HIMM) through simulations, AUV lake trial and semi-physical simulations. Experimental results show that our proposed algorithm has outstanding accuracy and robustness under heavy-tailed non-Gaussian noise environment.
22 May 2023 in IEEE Transactions on Instrumentation and Measurement
In order to improve the positioning accuracy and reliability of the navigation system in complex underwater environment, a strapdown inertial navigation system (SINS)/doppler velocity log (DVL)/Ultra-short baseline (USBL) tightly-coupled algorithm is proposed based on a centralized Kalman filter. A new 26-dimensional tightly-coupled measurement model is constructed. Different from the traditional loosely-coupled algorithm, the proposed model directly integrates the original measurement information of each sensor, instead of the navigation information such as position and velocity. Simulation and experiment results show that the proposed algorithm can make the best use of the only original information when the sensor cannot output the correct position and velocity in case of poor measurement conditions. Compared with the loosely-coupled algorithm, the proposed algorithm has better positioning accuracy and higher reliability.
19 August 2025 in IEEE Transactions on Automation Science and Engineering
In this paper, the high precision and robustness of underwater robot navigation based on strap-down inertial navigation system/ultra short base line (SINS/USBL) is investigated. The Extended Kalman Filter (EKF) is used to SINS/USBL system. An Iterated Extended Kalman Filter (IEKF) is proposed to enhance the robustness, which is based on Levenberg Marquardt (LM) and Laplace principles. IEKF state vector mean square error matrix is optimized based on LM algorithm. Meanwhile, measurement noise variance matrix is constructed based on Laplace principle. Considering the strong nonlinear problem of system noise and measurement noise, Particle Swarm Optimization (PSO) algorithm is introduced, and an Improved Particle Swarm Optimization (IPSO) algorithm is proposed. The mean-square error fitness function based on the position error of the navigation system is constructed. An improved inertia weight calculation method is proposed to further improve the adaptability of IPSO algorithm. The IPSO algorithm can adaptive estimate the system noise variance matrix and measurement noise variance matrix of IEKF. Finally, the SINS/USBL tightly integrated model is designed for proposed IPSO-IEKF algorithm, which based on slant and azimuth information. Simulation and experiment demonstrate the effectiveness of the proposed IPSO-IEKF algorithm. The experimental results show that the positioning accuracy of the proposed method is improved by 70% compared with EKF algorithm.
31 March 2025 in IEEE Transactions on Instrumentation and Measurement
Initial alignment is a crucial prerequisite for the performance of underwater integrated navigation systems, particularly in terms of alignment speed and accuracy. The limited maneuverability of underwater vehicles and the significant biases inherent in low-cost MEMS-IMUs pose considerable challenges to the effectiveness of in-motion initial alignment. To enhance the dynamic alignment performance of low-cost integrated navigation systems under conditions of limited maneuverability, a novel Kalman filter-assisted optimization alignment method that leverages velocity-integral-constraints is proposed. By constructing observations using the velocity integral spatial constraint relationship, the proposed method avoids the failure of acceleration observations due to insufficient maneuverability, providing a robust solution for dynamic alignment in such challenging scenarios. Additionally, a closed-loop correction strategy incorporating the Kalman filter technology is proposed to jointly estimate IMU biases and attitude errors, significantly enhancing the accuracy of observations in the dynamic alignment solution model. Simulation and field test results demonstrate that the proposed method offers significant improvements in alignment speed and accuracy, outperforming state-of-the-art methods for dynamic alignment of low-cost integrated navigation systems under conditions of limited maneuverability.