A new kind of quadrature Kalman particle filter is proposed for the state estimation of nonlinear/non-Gaussian systems. The new algorithm uses the quadrature Kalman filter(QKF)to generate the importance density function
and linearizes the nonlinear functions using the statistical linear regression method through a set of Gaussian-Hermite quadrature points. The algorithm does not evaluate the Jacobian matrix
and is easy to implement. Moreover
the importance density function integrates the latest observations into the system state transition density
so that the approximation to the system posterior density is improved. Theoretical analysis and experimental results show that
compared with the unscented particle filter(PF-UF)
the estimation accuracy of the new particle filter is improved by almost 18%
and its calculation cost is slightly reduced
which indicates the PF-QKF to be an effective nonlinear filtering algorithm.
关键词
Keywords
references
COSTA P. Adaptive model architecture and extended Kalman-Bucy filters [J]. IEEE Transactions on Aerospace and Electronic Systems, 1994, 30(2): 525-533.
GORDON N J, SALMOND D J, SMITH A F M. Novel approach to nonlinear/non-Gaussian Bayesian state estimation [J]. IEE Proceedings on Radar and Signal Processing, 1993, 140(2): 107-113.
Doucet A. On sequential simulation-based methods for Bayesian filtering, CUED/F-INFENG/TR.310 [R]. Cambridge,UK:Cambridge University Press, 1998: 1-26.
VAN DER MERWE R, DOUCET A, DE FREITAS N, et al. The unscented particle filter, CUED/F-INFEN G/TR, 380 [R]. Cambridge, UK: Cambridge University Press, 2000:1-45.
JULIER S J, UHLMANN J K. Unscented filtering and nonlinear estimation [J]. Proceedings of the IEEE, 2004, 92(3): 401-422.
ARASARATNAM I, HAYKIN S, ELLIOTT R J. Discrete-time nonlinear filtering algorithms using Gauss-Hermite quadrature [J]. Proceedings of the IEEE, 2007, 95(5): 953-977.
ITO K, XIONG K. Gaussian filters for nonlinear filtering problems [J]. IEEE Transactions on Automatic Control, 2000, 45(5): 910-927.
GOLUB G H, WELSCH J H. Calculation of Gauss Quadrature rules [J]. Math Comput, 1969, 23(106): 221-230.