Recursive nonlinear filtering for angular data based on circular distributions

Estimation of circular quantities is a widespread problem that occurs in many tracking and control applications. Commonly used approaches such as the Kalman filter, the extended Kalman filter (EKF), and the unscented Kalman filter (UKF) do not take periodicity explicitly into account, which can result in low estimation accuracy. We present a filtering algorithm for angular quantities in nonlinear systems that is based on circular statistics. The new filter switches between three different representations of probability distributions on the circle, the wrapped normal, the von Mises, and a Dirac mixture density. It can be seen as a systematic generalization of the UKF to circular statistics. We evaluate the proposed filter in simulations and show its superiority to conventional approaches.

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

[2]  J.M.C. Clark,et al.  The shifted Rayleigh filter for bearings only tracking , 2005, 2005 7th International Conference on Information Fusion.

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

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

[5]  Uwe D. Hanebeck,et al.  Recursive Bayesian calibration of depth sensors with non-overlapping views , 2012, 2012 15th 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]  T. Başar,et al.  A New Approach to Linear Filtering and Prediction Problems , 2001 .

[8]  Stergios I. Roumeliotis,et al.  A Kalman Filter-Based Algorithm for IMU-Camera Calibration: Observability Analysis and Performance Evaluation , 2008, IEEE Transactions on Robotics.

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

[10]  K. R. Parthasarathy,et al.  The Central Limit Theorem for the Rotation Group , 1964 .

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

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

[13]  R. Tennant Algebra , 1941, Nature.