Dual Quaternion Sample Reduction for SE(2) Estimation

We present a novel sample reduction scheme for random variables belonging to the SE(2) group by means of Dirac mixture approximation. For this, dual quaternions are employed to represent uncertain planar transformations. The Cramér-von Mises distance is modified as a smooth metric to measure the statistical distance between Dirac mixtures on the manifold of planar dual quaternions. Samples of reduced size are then obtained by minimizing the probability divergence via Riemannian optimization while interpreting the correlation between rotation and translation. We further deploy the proposed scheme for nonparametric modeling of estimates for nonlinear SE(2) estimation. Simulations show superior tracking performance of the sample reduction-based filter compared with Monte Carlo-based as well as parametric model-based planar dual quaternion filters.

[1]  Frank Dellaert,et al.  On-Manifold Preintegration for Real-Time Visual--Inertial Odometry , 2015, IEEE Transactions on Robotics.

[2]  Bamdev Mishra,et al.  Manopt, a matlab toolbox for optimization on manifolds , 2013, J. Mach. Learn. Res..

[3]  Neil J. Gordon,et al.  A tutorial on particle filters for online nonlinear/non-Gaussian Bayesian tracking , 2002, IEEE Trans. Signal Process..

[4]  Vibhav Vineet,et al.  Struck: Structured Output Tracking with Kernels , 2016, IEEE Transactions on Pattern Analysis and Machine Intelligence.

[5]  Gerhard Kurz,et al.  A new probability distribution for simultaneous representation of uncertain position and orientation , 2014, 17th International Conference on Information Fusion (FUSION).

[6]  Wolfgang Hess,et al.  Real-time loop closure in 2D LIDAR SLAM , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).

[7]  Uwe D. Hanebeck,et al.  Geometry-Driven Stochastic Modeling of SE(3) States Based on Dual Quaternion Representation , 2019, 2019 IEEE International Conference on Industrial Cyber Physical Systems (ICPS).

[8]  Gerhard Kurz,et al.  Nonlinear Progressive Filtering for SE(2) Estimation , 2018, 2018 21st International Conference on Information Fusion (FUSION).

[9]  Gerhard Kurz,et al.  Application of Discrete Recursive Bayesian Estimation on Intervals and the Unit Circle to Filtering on SE(2) , 2018, IEEE Transactions on Industrial Informatics.

[10]  Sebastian Thrun,et al.  Probabilistic robotics , 2002, CACM.

[11]  Gui-Song Xia,et al.  Object Tracking in Satellite Videos by Improved Correlation Filters With Motion Estimations , 2020, IEEE Transactions on Geoscience and Remote Sensing.

[12]  Jeffrey K. Uhlmann,et al.  Unscented filtering and nonlinear estimation , 2004, Proceedings of the IEEE.

[13]  Gerhard Kurz,et al.  Discrete recursive Bayesian filtering on intervals and the unit circle , 2016, 2016 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI).

[14]  Sebastian Thrun,et al.  FastSLAM: a factored solution to the simultaneous localization and mapping problem , 2002, AAAI/IAAI.

[15]  Roland Siegwart,et al.  Iterated extended Kalman filter based visual-inertial odometry using direct photometric feedback , 2017, Int. J. Robotics Res..

[16]  U. Hanebeck,et al.  Optimal Reduction of Dirac Mixture Densities on the 2-Sphere , 2020 .

[17]  Uwe D. Hanebeck.  Optimal Reduction of Multivariate Dirac Mixture Densities , 2015, Autom..

[18]  Gerhard Kurz,et al.  A stochastic filter for planar rigid-body motions , 2015, 2015 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems (MFI).

[19]  Uwe D. Hanebeck,et al.  Progressive Bayes: a new framework for nonlinear state estimation , 2003, SPIE Defense + Commercial Sensing.

[20]  Ronald P. S. Mahler,et al.  Statistical Multisource-Multitarget Information Fusion , 2007 .

[21]  Gerhard Kurz,et al.  Unscented Orientation Estimation Based on the Bingham Distribution , 2013, IEEE Transactions on Automatic Control.

[22]  Gerhard Kurz,et al.  Simultaneous Localization and Mapping Using a Novel Dual Quaternion Particle Filter , 2018, 2018 21st International Conference on Information Fusion (FUSION).

[23]  Levent Tunçel,et al.  Optimization algorithms on matrix manifolds , 2009, Math. Comput..

[24]  Uwe D. Hanebeck,et al.  Stereo Visual SLAM Based on Unscented Dual Quaternion Filtering , 2019, 2019 22th International Conference on Information Fusion (FUSION).

[25]  Uwe D. Hanebeck,et al.  Wavefront Orientation Estimation Based on Progressive Bingham Filtering , 2018, 2018 Sensor Data Fusion: Trends, Solutions, Applications (SDF).

[26]  Uwe D. Hanebeck,et al.  Localized Cumulative Distributions and a multivariate generalization of the Cramér-von Mises distance , 2008, 2008 IEEE International Conference on Multisensor Fusion and Integration for Intelligent Systems.

[27]  Wendelin Feiten,et al.  MPG - A Framework for Reasoning on 6 DOF Pose Uncertainty , 2017, ArXiv.

[28]  Uwe D. Hanebeck,et al.  Grid-Based Quaternion Filter for SO(3) Estimation , 2020, 2020 European Control Conference (ECC).