Unscented Orientation Estimation Based on the Bingham Distribution

In this work, we develop a recursive filter to estimate orientation in 3D, represented by quaternions, using directional distributions. Many closed-form orientation estimation algorithms are based on traditional nonlinear filtering techniques, such as the extended Kalman filter (EKF) or the unscented Kalman filter (UKF). These approaches assume the uncertainties in the system state and measurements to be Gaussian-distributed. However, Gaussians cannot account for the periodic nature of the manifold of orientations and thus small angular errors have to be assumed and ad hoc fixes must be used. In this work, we develop computationally efficient recursive estimators that use the Bingham distribution. This distribution is defined on the hypersphere and is inherently more suitable for periodic problems. As a result, these algorithms are able to consistently estimate orientation even in the presence of large angular errors. Furthermore, handling of nontrivial system functions is performed using an entirely deterministic method which avoids any random sampling. A scheme reminiscent of the UKF is proposed for the nonlinear manifold of orientations. It is the first deterministic sampling scheme that truly reflects the nonlinear manifold of orientations.

[1]  C. Herz.  BESSEL FUNCTIONS OF MATRIX ARGUMENT , 1955 .

[2]  Nicholas I. Fisher,et al.  Statistical Analysis of Spherical Data. , 1987 .

[3]  Alan Edelman,et al.  The efficient evaluation of the hypergeometric function of a matrix argument , 2006, Math. Comput..

[4]  Gary R. Bradski,et al.  Monte Carlo Pose Estimation with Quaternion Kernels and the Bingham Distribution , 2011, Robotics: Science and Systems.

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

[6]  Christopher Bingham.  An Antipodally Symmetric Distribution on the Sphere , 1974 .

[7]  Leslie Pack Kaelbling,et al.  Tracking 3-D Rotations with the Quaternion Bingham Filter , 2013 .

[8]  Nicholas I. Fisher,et al.  Statistical Analysis of Spherical Data. , 1987 .

[9]  Gerhard Kurz,et al.  Recursive estimation of orientation based on the Bingham distribution , 2013, Proceedings of the 16th International Conference on Information Fusion.

[10]  Gerhard Kurz,et al.  Recursive nonlinear filtering for angular data based on circular distributions , 2013, 2013 American Control Conference.

[11]  David E. Tyler.  Statistical analysis for the angular central Gaussian distribution on the sphere , 1987 .

[12]  Ken Shoemake,et al.  Animating rotation with quaternion curves , 1985, SIGGRAPH.

[13]  Serge Reboul,et al.  A multi-temporal multi-sensor circular fusion filter , 2014, Inf. Fusion.

[14]  S. R. Jammalamadaka,et al.  Directional Statistics, I , 2011 .

[15]  Tomonari Sei,et al.  Calculating the normalising constant of the Bingham distribution on the sphere using the holonomic gradient method , 2013, Stat. Comput..

[16]  Tamio Koyama,et al.  Holonomic gradient descent for the Fisher–Bingham distribution on the $$d$$d-dimensional sphere , 2012, Comput. Stat..

[17]  Berthold K. P. Horn,et al.  Closed-form solution of absolute orientation using unit quaternions , 1987 .

[18]  A. Wood,et al.  Saddlepoint approximations for the Bingham and Fisher–Bingham normalising constants , 2005 .

[19]  G. S. Watson,et al.  Equatorial distributions on a sphere , 1965 .

[20]  Jr. J.J. LaViola,et al.  A comparison of unscented and extended Kalman filtering for estimating quaternion motion , 2003, Proceedings of the 2003 American Control Conference, 2003..

[21]  E. Kraft,et al.  A quaternion-based unscented Kalman filter for orientation tracking , 2003, Sixth International Conference of Information Fusion, 2003. Proceedings of the.

[22]  Serge Reboul,et al.  A recursive fusion filter for angular data , 2009, 2009 IEEE International Conference on Robotics and Biomimetics (ROBIO).

[23]  Jack B. Kuipers,et al.  Quaternions and Rotation Sequences: A Primer with Applications to Orbits, Aerospace and Virtual Reality , 2002 .

[24]  Joseph J. LaViola,et al.  On Kalman Filtering With Nonlinear Equality Constraints , 2007, IEEE Transactions on Signal Processing.