Search papers, labs, and topics across Lattice.
This paper introduces a unified Block-Coordinate Descent framework that integrates norm-aware adaptive robust loss, Iteratively Reweighted Least-Squares state updates, and Minimum Weighted Covariance Determinant covariance estimation to address the challenges of outliers and non-Gaussian noise in sensor measurements. By simultaneously estimating state and covariance, the proposed method overcomes the limitations of traditional robust estimators and joint state estimators, which either reject outliers or assume Gaussian noise. Evaluated through Monte-Carlo simulations and real-world ultra-wideband localization experiments, the framework consistently recovers true inlier measurement covariance and achieves superior state estimation accuracy without manual parameter tuning.
A unified framework achieves robust state and covariance estimation in the presence of outliers, outperforming traditional methods without manual tuning.
Sensor measurements are frequently corrupted by outliers and non-Gaussian noise. These imperfections in the sensor data can cause classical state estimators to generate biased and unreliable state and uncertainty estimates. Robust estimators reject or downweight outliers but do not perform measurement covariance estimation, whereas joint state and covariance estimators assume Gaussian residuals and fixed loss shape parameters. Integrating these two capabilities into a single framework is an opportunity to simultaneously estimate both state and covariance in the presence of outliers. This paper proposes a unified Block-Coordinate Descent framework that combines a norm-aware adaptive robust loss, an Iteratively Reweighted Least-Squares state update, and a Minimum Weighted Covariance Determinant covariance estimator, yielding a self-tuning joint state and covariance estimator. The framework is evaluated in a Monte-Carlo simulation and on real-world ultra-wideband localization experiments in cluttered non-line-of-sight environments. Results show that the proposed estimator consistently recovers the true inlier measurement covariance and matches or exceeds the state estimation accuracy of all baselines, without requiring any manual parameter tuning.
