UD Covariance Factorization for Unscented Kalman Filter using Sequential Measurements Update

Authors: H. Ghanbarpour Asl, S. H. Pourtakdoust

Abstract:

Extended Kalman Filter (EKF) is probably the most widely used estimation algorithm for nonlinear systems. However, not only it has difficulties arising from linearization but also many times it becomes numerically unstable because of computer round off errors that occur in the process of its implementation. To overcome linearization limitations, the unscented transformation (UT) was developed as a method to propagate mean and covariance information through nonlinear transformations. Kalman filter that uses UT for calculation of the first two statistical moments is called Unscented Kalman Filter (UKF). Square-root form of UKF (SRUKF) developed by Rudolph van der Merwe and Eric Wan to achieve numerical stability and guarantee positive semi-definiteness of the Kalman filter covariances. This paper develops another implementation of SR-UKF for sequential update measurement equation, and also derives a new UD covariance factorization filter for the implementation of UKF. This filter is equivalent to UKF but is computationally more efficient.

Keywords: Unscented Kalman filter, Square-root unscentedKalman filter, UD covariance factorization, Target tracking.

Digital Object Identifier (DOI): doi.org/10.5281/zenodo.1071230

References:

[1] S. J. Julier, J. K. Uhlmann, and H. F. Durrant-Whyte. A new approach for filtering nonlinear systems. In Proc. of the 1995 American Control Conference, pages 1628-1632, Seattle, Washington, June 1995.
[2] P. S. Maybeck, Stochastic Models, Estimation, and Control, P. S. Maybeck, Ed. New York: Academic, 1982, vol. 1 and 2.
[3] H.J. Kushner, "Dynamical equatins for optimum no-linear filtering", J. Differential Equations, vol. 3,pp. 179-190, 1967.
[4] A. H. Jazwinski. Stochastic Processes and Filtering Theory. Academic Press, New York, 1970.
[5] N. J. Gordon, D. J. Salmond, and A. F. M. Smith, "Novel approach to Nonlinear/Non-Gaussian Bayesian State Estimation", In IEE Proceedings on Radar and Signal Processing, volume 140, no. 2, pp. 107-113,1993.
[6] H. J. Kushner, "Approximations to optimal nonlinear filters", IEEE Trans. Automat. Contr., vol. AC-12, pp. 546-556, Oct. 1967.
[7] F. E. Daum, "New exact nonlinear filters", in Bayesian Analysis of Time Series and Dynamic Models, J. C. Spall, Ed. New York: Marcel Dekker, 1988, pp.199-226.
[8] S. Julier, J. Uhlmann, and H. F. Durrant-Whyte," A new Approach for the Nonlinear Transformation of Means and Covariance in linear Filters", IEEE Transactions on Automatic Control, Vol. 5, No. 3, pp. 477-482, March 2000.
[9] S. J. Julier and J. K. Uhlmann, "A New Extension of the Kalman Filter to Nonlinear Systems," in Proc. of eroSense: The 11th Int. Symp. On Aerospace/Defense Sensing, Simulation and Controls, 1997.
[10] S. J. Julier and J. K. Uhlmann. "A general method for approximating nonlinear transformations of probability distributions. Technical report, Robotics Research Group, Department of Engineering Science, University of Oxford, 1994. (Internet publication:http://www.robots.ox.ac.uk/ fi siju/index.html).
[11] Rudolph van der Merwe and Eric A. Wan, "Efficient Derivative-Free Kalman Filters for Online Learning", ESANN'2001 proceedings - European Symposium on Artificial Neural Networks Bruges (Belgium), 25-27 April 2001, D-Facto public., ISBN 2-930307-01-3, pp. 205-210.
[12] Kazufumi Ito and Kaiqi Xiong, "Gaussian Filters for Nonlinear Filtering Problems," IEEE Transactions on Automatic Control, vol. 45, no. 5, pp. 910-927, may 2000.
[13] S. J. Julier and J. K. Uhlmann, "Unscented filtering and nonlinear estimation," Proc. IEEE, vol. 92, no. 3, pp. 401-422, Mar. 2004.
[14] S. Haykin, "Adaptive filter Theory", Prentice Hall, Inc, fourth edition, 2002.
[15] E. A. Wan and R. v. d. Merwe, "The unscented Kalman filter," In Kalman Filtering and Neural Networks, S. Haykin, Ed. New York: Wiley, 2001, ch. 7, pp. 221-280.
[16] R. v. d. Merwe, "Sigma-point Kalman filters for probabilistic inference in dynamic state-space models," electrical and computer engineering Ph.D. dissertation, Oregon Health Sciences Univ., Portland, OR, 2004.
[17] G. Minkler, J. Minkler, "Theory and Application of Kalman Filtering", Magellan Book Company, 1993.
[18] Grewal, M.S., Andrews, A.P., "Kalman Filtering Theory and Practice using Matlab," John Wiley & Sons, INC., 2001.
[19] R. van der Merwe, E. Wan, and S. J. Julier. Sigma-Point Kalman Filters for Nonlinear Estimation and Sensor-Fusion: Publications to Integrated Navigation. In Proceedings of the AIAA Guidance, Navigation & Control Conference, Providence, RI, Aug 2004.
[20] R. van der Merwe. Sigma-Point Kalman Filters for Probabilistic Inference in Dynamic State-Space Models. PhD thesis, OGI School of Science & Engineering at Oregon Health & Science University, Portland, OR, April 2004.
[21] Rudolph van der Merwe and Eric A. Wan, "Sigma-Point Kalman Filters for Integrated Navigation", in Proceedings of the 60th Annual Meeting of The Institute of Navigation (ION), Dayton, OH, Jun, 2004.
[22] R. van der Merwe and E. A. Wan, "The Square-Root Unscented Kalman Filter for State and Parameter- Estimation", in International Conference on Acoustics, Speech, and Signal Processing, Salt Lake City, Utah, Vol. 6, May, 2001, pp. 3461-3464.
[23] R. van der Merwe and E. A. Wan, "Efficient Derivative-Free Kalman Filters for Online Learning", in European Symposium on Artificial Neural Networks (ESANN), Bruges, Belgium, Apr, 2001.
[24] Eric A. Wan and Rudolph van der Merwe and Alex T. Nelson, "Dual Estimation and the Unscented Transformation", in Advances in Neural Information Processing Systems 12, pp. 666-672, MIT Press, Eds. S.A. Solla and T. K. Leen and K.-R. Muller, Nov, 2000.
[25] G. J. Bierman, "Factorization METHODS FOR Discrete Sequential Estimation", Academic, New York, 1977.
[26] C.L. Thornton, "Triangular Covariance Factorizations for Kalman Filtering", PHD. thesis, University of California at Los Angeles, School of Engineering, 1976.
[27] http://www.mathworld.com