Moving Target Tracking Algorithm Based on Improved Resampling Particle Filter in UWB Environment

Abstract

In this paper, a moving target tracking (MTT) algorithm based on the improved resampling particle filter (IRPF) was put forward for the reduced accuracy of particle filter (PF) due to the lack of particle diversity resulting from traditional resampling methods. In this algorithm, the influences of the likelihood probability distribution of particles on the PF accuracy were firstly analyzed to stratify the adaptive regions of particles, and a particle diversity measurement index based on stratification was proposed. After that, a threshold was set for the particle diversity after resampling. If the particle diversity failed to reach the set threshold, all new particles would be subjected to a Gaussian random walk in a preset variance matrix to improve the particle diversity. Finally, the performance of related algorithms was tested in both simulation environment and actual indoor ultrawideband (UWB) nonline-of-sight (NLOS) environment. The experimental results revealed that the nonlinear target state estimation accuracy was maximally and minimally improved by 12.83% and 1.97%, respectively, in the simulation environment, and the root mean square error (RMSE) of MTT was reduced from 17.131 cm to 10.471 cm in actual UWB NLOS environment, indicating that the IRPF algorithm can enhance the target estimation accuracy and state tracking capability, manifesting better filter performance.