Unscented Kalman filtering on Lie groups

Abstract

In this paper, we first consider a simple Bayesian fusion problem in a matrix Lie group, and propose to tackle it using the unscented transform. The method is then leveraged to derive two simple alternative unscented Kalman filters on Lie groups, for both cases of noisy partial measurements of the state, and full state noisy measurements of the state on the group. The general method is applied to a robot localization problem, and results based on experimental data combined with extensive Monte-Carlo simulations at various noise levels illustrate the superiority of the approach over the standard UKF.