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.

PARALLELIZED SIGMA POINT AND PARTICLE FILTERS FOR NAVIGATION PROBLEMS

Particle Filter-Based AUV Integrated Navigation Methods

Research of Parallel Strapdown Inertial Navigation Algorithm for High Dynamic Conditions

Fast Gaussian particle filtering algorithm

The Implementation of the Three-Dimensional Unified Gas-Kinetic Wave-Particle Method on Multiple Graphics Processing Units

Hardware Architecture and Optimisation of Fpp Particle Phd Filter for Multi-Target Tracking in Cyber-Physical Systems

Particle filters for positioning, navigation, and tracking

Computationally Efficient Unscented Kalman Filtering Techniques for Launch Vehicle Navigation using a Space-borne GPS Receiver

Optimization Algorithm for Kalman Filter Exploiting the Numerical Characteristics of SINS/GPS Integrated Navigation Systems

Research on Improved Gaussian Smoothing Filters for SLAM Application

A GPU-based Kalman Filter for Track Fitting

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

Application of Extended and Unscented Kalman Filtering for Non-Linear Positioning in Nearby Region of Navigation Sources

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

A time-efficient implementation of Extended Kalman Filter for sequential orbit determination and a case study for onboard application

Improving GPS Positioning Accuracy Based on Particle Filter Algorithm

An efficient parallel approach for quad-constellation GNSS real-time precise orbit determination enabling 5-second intervals updating

Enhanced Navigation Precision Through Interaction Multiple Filtering: Integrating Invariant and Extended Kalman Filters

Revisiting multi-GNSS Navigation for UAVs -- An Equivariant Filtering Approach

Particle Filter Based Approach to Fast Multisensor Fusion with Its Application to Navigation

Kalman-Filter-Based Particle Tracking on Parallel Architectures at Hadron Colliders