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.

The expanded central difference filter for GNSS with unknown state dynamics

Precise satellite-ground baseline determination

State transformation extended Kalman filter for GPS/SINS tightly coupled integration

Integrating Extreme Learning Machine with Kalman Filter to Bridge GPS Outages

Strong tracking filter modeling for GPS robust navigation

Navigation for fixed-wing unmanned aerial vehicles in the presence of GNSS outages

Research on Kinematic and Static Filtering of the ESKF Based on INS/GNSS/UWB

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

Robust Central Difference Kalman Filter With Mixture Correntropy: A Case Study for Integrated Navigation

A Redundant Measurement-Based Maximum Correntropy Extended Kalman Filter for the Noise Covariance Estimation in INS/GNSS Integration

A novel robust progressive cubature Kalman filter with variable step size for inertial navigationsystem/global navigation satellite system tightly coupled navigation

Improving GPS Positioning Accuracy Based on Particle Filter Algorithm

A Robust Nonlinear Filter Strategy Based on Maximum Correntropy Criterion for Multi-GNSS and Dual-Frequency RTK

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

SINS/GPS integrated navigation system using an improved particle filter based on state reconstruction

A New Adaptive H-Infinity Filtering Algorithm for the GPS/INS Integrated Navigation

Enhanced Redundant Measurement-Based Kalman Filter for Measurement Noise Covariance Estimation in INS/GNSS Integration

The Gaussian Convolution Filter and Its Application to Navigation

An improved GNSS/INS navigation method based on Cubature Kalman Filter for occluded environment

AGMC-Based Robust Cubature Kalman Filter for SINS/GNSS Integrated Navigation System With Unknown Noise Statistics

Filtering Performance Analyizing for Relative Navigation Using Single Difference Carrier-Phase GPS