Recursive Bayesian filtering in circular state spaces

To facilitate recursive state estimation in the circular domain based on circular statistics, we introduce a general framework for estimation of a circular state based on different circular distributions. Specifically, we consider the wrapped normal (WN) distribution and the von Mises distribution. We propose an estimation method for circular systems with nonlinear system and measurement functions. This is achieved by relying on efficient deterministic sampling techniques. Furthermore, we show how the calculations can be simplified in a variety of important special cases, such as systems with additive noise, as well as identity system or measurement functions, which are illustrated using an example from aeronautics. We introduce several novel key components, particularly a distribution-free prediction algorithm, a new and superior formula for the multiplication of WN densities, and the ability to deal with nonadditive system noise. All proposed methods are thoroughly evaluated and compared with several state-of-the-art approaches.

[1]  K. Mardia Characterizations of Directional Distributions , 1975 .

[2]  Paris Smaragdis,et al.  A Wrapped Kalman Filter for Azimuthal Speaker Tracking , 2013, IEEE Signal Processing Letters.

[3]  David Frederic Crouse,et al.  Cubature/unscented/sigma point Kalman filtering with angular measurement models , 2015, 2015 18th International Conference on Information Fusion (Fusion).

[4]  John E. Gray,et al.  The Rayleigh problem is everywhere! , 2010, Defense + Commercial Sensing.

[5]  Uwe D. Hanebeck,et al.  S2KF: The Smart Sampling Kalman Filter , 2013, Proceedings of the 16th International Conference on Information Fusion.

[6]  Nicholas Roy,et al.  State estimation for aggressive flight in GPS-denied environments using onboard sensing , 2012, 2012 IEEE International Conference on Robotics and Automation.

[7]  Gerhard Kurz,et al.  Nonlinear measurement update for estimation of angular systems based on circular distributions , 2014, 2014 American Control Conference.

[8]  Uwe D. Hanebeck,et al.  Moment-based Dirac Mixture Approximation of Circular Densities , 2014 .

[9]  Gerhard Kurz,et al.  Bivariate angular estimation under consideration of dependencies using directional statistics , 2014, 53rd IEEE Conference on Decision and Control.

[10]  Reginald Gordon Harris,et al.  Mathematics in biology , 1935 .

[11]  D. Owen Handbook of Mathematical Functions with Formulas , 1965 .

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

[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]  Gerhard Kurz,et al.  Deterministic approximation of circular densities with symmetric Dirac mixtures based on two circular moments , 2014, 17th International Conference on Information Fusion (FUSION).

[16]  Georges Stienne,et al.  Traitements des signaux circulaires appliqués à l'altimétrie par la phase des signaux GNSS. (Circular signal processing applied to altimetry using GNSS signals phase) , 2013 .

[17]  S. F. Schmidt APPLICATION OF STATISTICAL FILTER THEORY TO THE OPTIMAL ESTIMATION OF POSITION AND VELOCITY ON BOARD A CIRCUMLUNAR VEHICLE , 2022 .

[18]  N. I. Fisher Problems with the Current Definitions of the Standard Deviation of Wind Direction , 1987 .

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

[20]  Alan S. Willsky,et al.  Fourier series and estimation on the circle with applications to synchronous communication-I: Analysis , 1974, IEEE Trans. Inf. Theory.

[21]  Kanti V. Mardia,et al.  A multivariate von mises distribution with applications to bioinformatics , 2008 .

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

[23]  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.

[24]  Gerhard Kurz Directional Estimation for Robotic Beating Heart Surgery , 2015 .

[25]  Kanti V. Mardia,et al.  A Model for Cylindrical Variables with Applications , 1978 .

[26]  I. Introductiok Estimation for Rotational Processes with One Degree of Freedom-Part I1 : Discrete-Time Processes , 1975 .

[27]  Alan S. Willsky Fourier series and estimation on the circle with applications to synchronous communication-II: Implementation , 1974, IEEE Trans. Inf. Theory.

[28]  Kristine L. Bell,et al.  A Tutorial on Particle Filters for Online Nonlinear/NonGaussian Bayesian Tracking , 2007 .

[29]  Gerhard Kurz,et al.  Nonlinear stochastic model predictive control in the circular domain , 2015, 2015 American Control Conference (ACC).

[30]  Gerhard Kurz,et al.  Bearings-only sensor scheduling using circular statistics , 2013, Proceedings of the 16th International Conference on Information Fusion.

[31]  Petar M. Djuric,et al.  Gaussian particle filtering , 2003, IEEE Trans. Signal Process..

[32]  Gerhard Kurz,et al.  Constrained object tracking on compact one-dimensional manifolds based on directional statistics , 2013, International Conference on Indoor Positioning and Indoor Navigation.

[33]  F. Markley Attitude Error Representations for Kalman Filtering , 2003 .

[34]  Samuel Kotz,et al.  A Modern Course on Statistical Distributions in Scientific Work , 1975 .

[35]  M. Abramowitz,et al.  Handbook of Mathematical Functions With Formulas, Graphs and Mathematical Tables (National Bureau of Standards Applied Mathematics Series No. 55) , 1965 .

[36]  S. Reboul,et al.  Circular data processing tools applied to a Phase Open Loop architecture for multi-channels signals tracking , 2012, Proceedings of the 2012 IEEE/ION Position, Location and Navigation Symposium.

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

[38]  Ivan Markovic,et al.  Moving object detection, tracking and following using an omnidirectional camera on a mobile robot , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[39]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

[40]  Alessandro Chiuso,et al.  Visual tracking of points as estimation on the unit sphere , 1997, Block Island Workshop on Vision and Control.

[41]  Sandra Hirche,et al.  Rigid motion estimation using mixtures of projected Gaussians , 2013, Proceedings of the 16th International Conference on Information Fusion.

[42]  Suvrit Sra,et al.  A short note on parameter approximation for von Mises-Fisher distributions: and a fast implementation of Is(x) , 2012, Comput. Stat..

[43]  S. R. Jammalamadaka,et al.  Topics in Circular Statistics , 2001 .

[44]  Serge Reboul,et al.  Cycle slip detection and repair with a circular on-line change-point detector , 2014, Signal Process..

[45]  Karim El Mokhtari,et al.  A circular interacting multi-model filter applied to map matching , 2013, Proceedings of the 16th International Conference on Information Fusion.

[46]  Georges Stienne,et al.  Traitement des signaux circulaires appliqués à l'altimétrie par la phase des signaux GNSS. (Circular signals processing applied to altimetry using the phase of GNSS signals) , 2013 .

[47]  G. Chirikjian Stochastic Models, Information Theory, and Lie Groups, Volume 1 , 2009 .

[48]  Joseph Tabrikian,et al.  Cyclic Bayesian Cramér-Rao bound for filtering in circular state space , 2015, 2015 18th International Conference on Information Fusion (Fusion).

[49]  E. Jaynes The well-posed problem , 1973 .

[50]  Leslie Pack Kaelbling,et al.  Tracking the spin on a ping pong ball with the quaternion Bingham filter , 2014, 2014 IEEE International Conference on Robotics and Automation (ICRA).

[51]  Ali T. Alouani,et al.  Characterization of the PDFs of coordinate transformations in tracking , 2014, IEEE Transactions on Aerospace and Electronic Systems.

[52]  Gerhard Kurz,et al.  Efficient evaluation of the probability density function of a wrapped normal distribution , 2014, 2014 Sensor Data Fusion: Trends, Solutions, Applications (SDF).

[53]  I. Bar-Itzhack,et al.  Novel quaternion Kalman filter , 2002, IEEE Transactions on Aerospace and Electronic Systems.

[54]  W. K. Hastings,et al.  Monte Carlo Sampling Methods Using Markov Chains and Their Applications , 1970 .

[55]  A. Al-Sharadqah,et al.  Error analysis for circle fitting algorithms , 2009, 0907.0421.

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

[57]  Kaare Brandt Petersen,et al.  The Matrix Cookbook , 2006 .

[58]  K. Mardia Directional statistics in geosciences , 1981 .

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

[60]  Milton Abramowitz,et al.  Handbook of Mathematical Functions with Formulas, Graphs, and Mathematical Tables , 1964 .

[61]  Uwe D. Hanebeck,et al.  PGF 42: Progressive Gaussian filtering with a twist , 2013, Proceedings of the 16th International Conference on Information Fusion.

[62]  Gerhard Kurz,et al.  Multimodal circular filtering using Fourier series , 2015, 2015 18th International Conference on Information Fusion (Fusion).

[63]  D. E. Amos,et al.  Computation of modified Bessel functions and their ratios , 1974 .

[64]  Aubrey B. Poore,et al.  Gauss von Mises Distribution for Improved Uncertainty Realism in Space Situational Awareness , 2014, SIAM/ASA J. Uncertain. Quantification.

[65]  Uwe D. Hanebeck,et al.  Extended Object Tracking with Random Hypersurface Models , 2013, IEEE Transactions on Aerospace and Electronic Systems.

[66]  B. Heller Circular Statistics in Biology, Edward Batschelet. Academic Press, London & New York (1981), 371, Price $69.50 , 1983 .