A Stochastic Filter for Planar Rigid-Body Motions

This paper presents a novel algorithm for the
estimation of planar rigid-body motions. It is based on using a
probability distribution that is inherently defined on the non-
linear manifold representing these motions and on proposing
a deterministic sampling scheme that makes consideration of
complicated system models possible. Furthermore, we show
that the measurement update for a manifold equivalent to
noisy direct measurements can be carried out in closed form.
Thus, the resulting method avoids errors made due to local
linearization and outperforms methods that wrongly assume
Gaussian distributions, which we show by comparing the
proposed filter to the UKF.