Search papers, labs, and topics across Lattice.
This paper introduces ALS-IRLS, an outlier-robust autocovariance least squares algorithm for Kalman filter noise covariance estimation. The method uses a two-tier robustification strategy involving innovation-level adaptive thresholding and Huber cost function-based IRLS to mitigate the impact of outliers. Experiments show ALS-IRLS reduces RMSE of noise covariance estimates by two orders of magnitude compared to standard ALS and achieves state estimation accuracy close to the Oracle lower bound in noisy environments.
Even with heavy noise and outliers, this new algorithm estimates noise covariances for Kalman filters so well that it nearly matches the impossible-to-achieve "Oracle" lower bound on performance.
The autocovariance least squares (ALS) method is a computationally efficient approach for estimating noise covariances in Kalman filters without requiring specific noise models. However, conventional ALS and its variants rely on the classic least mean squares (LMS) criterion, making them highly sensitive to measurement outliers and prone to severe performance degradation. To overcome this limitation, this paper proposes a novel outlier-robust ALS algorithm, termed ALS-IRLS, based on the iteratively reweighted least squares (IRLS) framework. Specifically, the proposed approach introduces a two-tier robustification strategy. First, an innovation-level adaptive thresholding mechanism is employed to filter out heavily contaminated data. Second, the outlier-contaminated autocovariance is formulated using an $ε$-contamination model, where the standard LMS criterion is replaced by the Huber cost function. The IRLS method is then utilized to iteratively adjust data weights based on estimation deviations, effectively mitigating the influence of residual outliers. Comparative simulations demonstrate that ALS-IRLS reduces the root-mean-square error (RMSE) of noise covariance estimates by over two orders of magnitude compared to standard ALS. Furthermore, it significantly enhances downstream state estimation accuracy, outperforming existing outlier-robust Kalman filters and achieving performance nearly equivalent to the ideal Oracle lower bound in the presence of noisy and anomalous data.
