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.

Application of Improved UPF in GPS/DR Combined Navigation

Particle Filter-Based AUV Integrated Navigation Methods

Research of STUPF Filter Algorithm on GPS/SINS

UPF based autonomous navigation scheme for deep space probe

UPF-based Fault Detection Method of Integrated Navigation System with Non-Gaussian Noises

Integration of GPS Precise Point Positioning and MEMS-Based INS Using Unscented Particle Filter

Refined Aircraft Positioning Based on Stochastic Hybrid Estimation with Adaptive Square-Root Unscented Particle Filtering

An Improved Unscented Particle Filter with Global Sampling Strategy.

Spacecraft autonomous navigation using unscented particle filter-based celestial/Doppler information fusion

Bridging GPS Outages for Fixed-wing Unmanned Aerial Vehicles

Adaptive Particle Filtering With Variational Bayesian and Its Application for INS/GPS Integrated Navigation

Distributed multi‐station target tracking based on unscented particle filter and Dempster‐Shafer theory

An adaptive information fusion method to vehicle integrated navigation

Tightly coupled integration of vector HD map, LiDAR, GNSS, and INS for precise vehicle navigation in GNSS-challenging environment

Robustly Adaptive EKF PDR/UWB Integrated Navigation Based on Additional Heading Constraint

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

A Comparative Study of Factor Graph Optimization-Based and Extended Kalman Filter-Based PPP-B2b/INS Integrated Navigation

An Time Delay Difference Estimation Algorithm Based on Improved Unscented Particle Filter Suitable for Target Tracking in Wireless Sensor Network

Robust GPS/INS/DVL Navigation and Positioning Method Using Adaptive Federated Strong Tracking Filter Based on Weighted Least Square Principle

Better Proposal Distributions: Object Tracking Using Unscented Particle Filter

UPDs estimation and ambiguity resolution performance evaluation of LEO navigation system