Robust particle filter based on Huber function for underwater terrain-aided navigation

摘要

Terrain-aided navigation (TAN) is a promising technique to determine the location of underwater vehicle by matching terrain measurement against a known map. The particle filter (PF) is a natural choice for TAN because of its ability to handle non-linear, multimodal problems. However, the terrain measurements are vulnerable to outliers, which will cause the PF to degrade or even diverge. Modification of the Gaussian likelihood function by using robust cost functions is a way to reduce the effect of outliers on an estimate. The authors propose to use the Huber function to modify the measurement model used to set importance weights in a PF. They verify their method in simulations of multi-beam sonar in a real underwater digital map. The results demonstrate that the proposed method is more robust to outliers than the standard PF (SPF).