An Improved Approach of Terrain-Aided Navigation Based on RBPF

摘要

Rao-Blackwellized Particle Filter (RBPF) is suitable for solving the linear/nonlinear mixed Terrain-Aided Navigation (TAN) problem. But the Particle Filter (PF) part of RBPF is Standard Particle Filter (SPF), causing particle diversity reduction and even filter's divergence under extreme conditions. To get a better estimation of the errors of INS, this paper proposes an improved approach called Regularized Rao-Blackwellized Particle Filter (RRBPF). After updating the nonlinear state and corresponding importance weights, RRBPF resamples from the Epanechnikov kernel and then get the resampled particles through a linear transition process. Theoretically, the resampling part of RRBPF is equivalent to resampling from the approximated continuous posterior probability density function. Shuttle Radar Topography Mission (SRTM) terrain data is used in simulations to investigate the performance of RRBPF. Results show that RRBPF can provide more accurate estimation of TAN and bear larger initial position error than Sandia Inertial Terrain Aided Navigation (SITAN).