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.

Design of Efficient Point-Mass Filter with Application in Terrain Aided Navigation

Tracking of time-evolving sound speed profiles in shallow water using an ensemble Kalman-particle filter.

Efficient Particle Filter and Its Application in Contour Tracking

Visual Object Tracking Based on Motion-Adaptive Particle Filter under Complex Dynamics

Efficient Spectral Differentiation in Grid-Based Continuous State Estimation

Particle filters for positioning, navigation, and tracking

Particle Filter Based On Partial Accurate Observation For High Dimensional Stochastic Dynamic System

Strong tracking filter modeling for GPS robust navigation

Urban Rtk Using Adaptive Point Mass Filter with Wide-Lane Measurements

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

A Predictive Gradient-Based Filtering Method for State Estimation of MEMS Micromirrors

A non-rigid terrain transformation particle filter suitable for terrain-aided navigation without sound velocity profile

Terrain Matching Based on Adaptive Digital Elevation Map

Neural Projection Filter: Learning Unknown Dynamics Driven by Noisy Observations.

Application Of Improved Particle Filter Based On State Reconstruction On Sins/Gps

Statically Fused Smooth Variable Structure Filter for Robust Tracking with Doppler Radar

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

Stochastic Integration Based Estimator: Robust Design and Stone Soup Implementation

PMBM Filtering With Fusion of Target-Provided and Exteroceptive Measurements: Applications to Maritime Point and Extended Object Tracking

UD-based pairwise and MIMO Kalman-like filtering for estimation of econometric model structures

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