UD Covariance Factorization for Unscented Kalman Filter using Sequential Measurements Update

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.

Authors:

• H. Ghanbarpour Asl
• S. H. Pourtakdoust

Keywords:

• Unscented Kalman filter
• Square-root unscentedKalman filter
• UD covariance factorization
• Target tracking.

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