Moving horizon estimation for localization of mobile robots with measurement outliers

Abstract

This paper investigates the moving horizon estimation (MHE) problem of mobile robots with measurement outliers. To deal with measurement outliers, the Euclidean distance of measurement error is introduced to detect and remove abnormal data. Then, we use dimension expansion methods to preprocess the data of heterogeneous sensors, such as UWB and IMU. An MHE-based method is proposed that deals with the localization of mobile robots with measurement outliers in the presence of bounded noise. An MHE-based estimator is obtained by solving a regularized least-squares problem. We analyze the convergence of the estimation error system using the properties of norm inequalities, and an upper bound is derived for the estimation error system by using norm inequality. Finally, simulation and experiment examples are given to verify the effectiveness and applicability of the proposed approach.