Nonlinear Progressive Filtering for SE(2) Estimation
Kailai Li, Gerhard Kurz, Lukas Bernreiter, Uwe D. Hanebeck · 2018
In this paper, we present a novel nonlinear progressive filtering approach for estimatingSE(2) states represented by unit dual quaternions. Unlike previously published approaches, the measurement model no longer needs to be assumed as identity. Our solution utilizes deterministic sampling on a Bingham-like probability distribution, which has been adapted to simultaneously model orientation and translation. During the measurement update step, the estimate gets progressively updated. Our approach inherently incorporates the nonlinear structure ofSE(2) and enables a flexible measurement update step. We also give an evaluation for planar rigid body motion estimation with a case study that is close to real-world scenarios.