Abstract:Measurement and Control, Ahead of Print. To address particle degeneracy and the challenge of selecting importance density functions in traditional particle filters for complex nonlinear systems, we propose an adaptive mixed-order spherical simplex-radial cubature particle filter algorithm based on constrained optimization and fading memory. This algorithm integrates constrained optimization, an adaptive fading memory strategy, adaptive adjustment of particle numbers and weights, and the advantages of mixed-order spherical simplex-radial cubature Kalman filtering. By designing the importance density function using a mixed-order integration method, the algorithm significantly improves filtering accuracy over traditional cubature Kalman filters while maintaining lower computational complexity than high-order cubature Kalman filter methods. The adaptive fading memory strategy dynamically adjusts the covariance matrix, enhancing sensitivity to current measurement information and reducing the influence of historical data. By dynamically adjusting the noise covariance matrix and constraining the ratio between the error covariance and measurement noise covariance, the algorithm improves the convergence speed and accuracy of state estimation. An adaptive particle number and weight adjustment strategy based on effective sample size and entropy regularization dynamically adjusts the number of particles to reduce computational complexity while ensuring filtering accuracy, and employs entropy regularization to suppress weight over-concentration, thereby reducing the impact of outliers on the filtering results. Simulation results demonstrate that in complex SINS/GNSS integrated navigation systems, especially under high-noise and nonlinear conditions, the proposed algorithm significantly improves positioning accuracy compared to the CPF method, with the maximum latitude error reduced by approximately 54.8%, the maximum longitude error reduced by approximately 40.5%, and the maximum altitude error reduced by approximately 68.3%. Compared to the FMCPF method, the proposed algorithm also shows clear advantages in positioning accuracy, convergence speed, and computational efficiency, validating its effectiveness and practicality in complex environments.

A Novel Adaptive Square Root Recursive Least Squares Filter Algorithm of SINS/SAR Integrated Navigation Systems

Integrated Navigation for an Autonomous Underwater Vehicle Carrying Synthetic Aperture Sonar

Model Aided Airborne Integrated Navigation System Based on an Improved Square-Root Unscented H∞ Filter

Improving Navigational Accuracy for AUVs Based on an Adaptive Modified Square-Root Cubature Kalman Filter

Study on the Robust Filter Method of SINS/DVL Integrated Navigation Systems in a Complex Underwater Environment

Fuzzy Kalman Filtering for SINS/GPS Integrated Navigation System

A novel adaptive nonlinear Kalman filter scheme for DVL-aided SINS alignment in underwater vehicles

A Dual Adaptive Unscented Kalman Filter Algorithm for SINS-based Integrated Navigation System

Seamless GPS/Inertial Navigation System Based on Self-Learning Square-Root Cubature Kalman Filter

Underwater Adaptive Height-Constraint Algorithm Based on SINS/LBL Tightly Coupled

Variational Bayesian-Based Adaptive Error-State Kalman Filter With Application on LiDAR-Inertial Integrated Navigation System

RL-AKF: An Adaptive Kalman Filter Navigation Algorithm Based on Reinforcement Learning for Ground Vehicles

Modified Sage-Husa Adaptive Kalman Filter-Based SINS/DVL Integrated Navigation System for AUV

A Polar Robust Kalman Filter Algorithm for DVL-Aided SINSs Based on the Ellipsoidal Earth Model

Correlation-Averaging Methods and Kalman Filter-based Parameter Identification for Rotational Inertial Navigation System

An Adaptive Cubature Kalman Filter Based on Resampling-Free Sigma-Point Update Framework and Improved Empirical Mode Decomposition for INS/CNS Navigation

System noise variance matrix adaptive Kalman filter method for AUV INS/DVL navigation system

Adaptive MSSRCPF filtering based on constrained optimization and fading memory for SINS/GNSS integrated navigation

A new SINS/GPS sensor fusion scheme for UAV localization problem using nonlinear SVSF with covariance derivation and an adaptive boundary layer

Variational Bayesian-Based Robust Cubature Kalman Filter With Application on SINS/GPS Integrated Navigation System

Seamless MEMS-INS/Geomagnetic Navigation System Based on Deep-Learning Strong Tracking Square-Root Cubature Kalman Filter