Continuous-time filtering in Lie groups: estimation via the Fr{é}chet mean of solutions to stochastic differential equations

Abstract

We compute the Fréchet mean ${\mathcal{E}}_t$ of the solution $X_t$ to a continuous-time stochastic differential equation in a Lie group. It provides an estimator with minimal variance of $X_t$. We use it in the context of Kalman filtering and more precisely to infer rotation matrices. In this paper, we focus on the prediction step between two consecutive observations. Compared to state-of-the-art approaches, our assumptions on the model are minimal.