Professional Documents
Culture Documents
Authorized licensed use limited to: INSTITUTO MILITAR DE ENGENHARIA. Downloaded on September 01,2022 at 13:02:49 UTC from IEEE Xplore. Restrictions apply.
2016 IEEE First International Conference on Control, Measurement and Instrumentation (CMI)
Figure 2: Missile trajectory of position vs time. Figure 4: Missile trajectory of acceleration vs time.
B. Measurement Model
The position of the missile is measuring using ground based
radar at every sampling interval of time. The measurement
equation is taken as linear and white Gaussian noise is cor-
rupted with zero mean of covariance Rk
yk = Hxk + νk , (7)
460
Authorized licensed use limited to: INSTITUTO MILITAR DE ENGENHARIA. Downloaded on September 01,2022 at 13:02:49 UTC from IEEE Xplore. Restrictions apply.
2016 IEEE First International Conference on Control, Measurement and Instrumentation (CMI)
Kk = Pk|k−1 GT (GPk|k−1 GT + Rk )−1 (13) where f (.) is an arbitrary function, qi and wi are quadrature
points and their respective weights. For m-point quadrature
where G matrix is defined as G = [01×n I1×p ]. rule, it is exact upto polynomial of degree (2m − 1). To
calculate the quadrature points, we have taken a symmetric
Estimate ensemble points triangular matrix J with zero diagonal elements
j
Zk|k j
= Zk|k−1 j
+ Kk (yk,0 j
− yk|k−1 ) (14)
Ji,i+1 = i/2, 1 i (m − 1). (20)
j
where, yk,0 are calculated using measurement noise distribu- √
j The quadrature points qi = 2ξi , where ξi are the ith eigen
tion, yk,0 ∼ ℵ(yk , Rk ). value of J. The ith weight wi is chosen as wi = ki1 2
, where
Step 4: EnKF estimate ki1 is the first element of the ith normalized eigenvector of J.
Calculate mean Now, we apply product rule to generate support points for
multidimensional system. Applying product rule, we get
N
1
j
Ẑk|k = Z (15) m
m
N j=1 k|k IN ≈ ... f (qi1 , qi2 .., qin )wi1 wi2 ...win . (21)
i1 =1 in =1
Estimated states X̂k|k = M Ẑk|k . Where, matrix M is defined
as M = [I1×n 01×p ]. In n-dimensional integral system with m-point single dimen-
sional Gauss-Hermite quadrature rule has total mn multidi-
mensional points. Hence the filter suffers from the curse of
B. Cubature Quadrature Kalman Filter
dimensionality problem.
The CQKF [10] is a nonlinear filter, which is based on
spherical radial quadrature and Gauss-Laguerre quadrature
rule. For first order Gauss-Laguerre quadrature, CQKF is same D. Sparse grid Gauss-Hermite Filter
as CKF. The SGHF [13], [14] uses sparse-grid quadrature rule for
Cubature quadrature points and weights are calculated from finding points and weights. It works on deterministic sampling
approximated integral I(f ) as, point approach. For univariate, GHF and SGHF have same
quadrature points and weights. In multivariate, GHF faces the
2n
n curse of dimensionality problem. SGHF uses Smolyak’s rule
1
I(f ) ≈ Ai f ( 2λi [ui ]) , (16) for generation of points and weights, which is free from the
2nΓ(n/2) i=1 curse of dimensionality problem. The sparse-grid integral is
i =1
defined as,
where, n represents the order of Gauss-Laguerre polynomial.
CQKF has total 2nn points, where n represents the dimension
of the state model. When n = 1, then CQKF merges with f (x)ℵ(x; 0, In )dx ≈ In,L (f ) (22)
Rn
CKF. λi is the Gauss-Laguerre quadrature points, which is
determined from Chebyshev-Laguerre polynomial equation, L−1
L−1−q
d
n In,L (f ) = (−1)L−1−q Cn−1 (Ii1 ⊗Ii2 ...⊗Iin )(f )
Lα
n = (−1)n λ−α eλ n λα+n e−λ = 0 (17) q=L−n Ξ∈Nqn
dλ
(23)
n !Γ(α + n + 1) where In,L is the approximation of the n-dimensional integral
and Ai = is the Gauss-Laguerre weights.
λi [L̇α 2 of function f (.) with Gaussian weights ℵ(x, 0, In ) with accu-
n (λi )]
where α = (n/2 − 1). racy level L ∈ N. It gives the exact solution for all polynomial
upto degree (2L − 1). C denotes as a binomial coefficient,
Now, from
√ equation (16), we get a cubature quadrature defined by Ckn = n!/k!(n − k)!, where n! denote as a factorial
points ξj = 2λi [ui ] and its corresponding weights wj as, of n. ⊗ denotes the tensor product. Iij is a single dimensional
1 n !Γ(α + n + 1) quadrature rule where ij ∈ Ξ is the accuracy level. It means
wj = Ai = (18) that Iij gives exact result upto polynomial of degree 2ij − 1.
2nΓ(n/2) λi [L̇α
n (λi )]
2
The accuracy level sequence
for i = 1, 2, ..., 2n, i = 1, 2, ..., n and j = 1, 2, ..., 2nn ,
n
where n is dimension and n is the order of Gauss-Laguerre n {Ξ : j=1 ij = n + q} f or q 0
Nq = (24)
quadrature points. ∅ f or q < 0
461
Authorized licensed use limited to: INSTITUTO MILITAR DE ENGENHARIA. Downloaded on September 01,2022 at 13:02:49 UTC from IEEE Xplore. Restrictions apply.
2016 IEEE First International Conference on Control, Measurement and Instrumentation (CMI)
In,L (f ) = ....
q=L−n Ξ∈Nqn qs1 ∈Xi1 qsn ∈Xin
n
(25)
L−1−q
L−1−q
f (qs1 , ..., qsn ) × {(−1) Cn−1 w sj }
j=1
462
Authorized licensed use limited to: INSTITUTO MILITAR DE ENGENHARIA. Downloaded on September 01,2022 at 13:02:49 UTC from IEEE Xplore. Restrictions apply.
2016 IEEE First International Conference on Control, Measurement and Instrumentation (CMI)
R EFERENCES
[1] N. K. Singh, S. Bhaumik and S. Bhattacharya, ”Tracking of ballistic
target on re-entry using ensemble Kalman filter,” in Proc. IEEE Indicon.,
Dec. 2012.
[2] M. Srinivasan, S. Sadhu and T. K. Ghoshal, ”Ground-based radar tracking
of ballistic target on re-entry phase using derivative-free filters,” in Proc.
IEEE Indicon., Sep. 2006.
[3] A. Farina, B. Ristic and D. Benvenuti, ”Tracking a ballistic target:
comparison of several nonlinear filters,” IEEE Trans. Aerosp. Electron.
Syst., vol. 38, no. 3, pp. 854-867, July 2002.
[4] B. Ristic, A. Farina, D. Benvenuti and M. S. Arulampalam, ”Performance
bounds and comparison of nonlinear filters for tracking a ballistic object
on re-entry,” IET IEE Proc. Radar Sonar Navig., vol. 150, no. 2, pp.
65-70, Apr. 2003.
[5] R. K. Mehra, ”A comparison of several nonlinear filters for reentry
vehicle tracking,” IEEE Trans. Automat. Control, vol.16, no. 4, pp. 307-
319, Aug. 1971.
[6] G. Evensen, ”The ensemble Kalman filter: theoretical formulation and
practical implementation,” Ocean Dynamics, vol. 53, no. 4, pp. 343-367,
Nov. 2003.
Figure 9: Std. dev. of velocity error for various filters.
[7] R. J. Lorentzen and G. Naevdal, ”An iterative ensemble Kalman filter,”
IEEE Trans. Autom. Control, vol. 56, no. 8, pp. 1990-1995, Aug. 2011.
[8] C. Antoniou, M. Ben-Akiva and H. N. Koutsopoulos, ”Nonlinear Kalman
filtering algorithms for on-line calibration of dynamic traffic assignment
models,” IEEE Trans. Intell. Transp. Syst., vol. 8, no. 4, pp. 661-670,
Dec. 2007.
[9] E. A. Wan and R. Van Der Merwe, ”The unscented Kalman filter for
nonlinear estimation,” in Proc. IEEE ASSPCC., Oct. 2000.
[10] S. Bhaumik and Swati, ”Cubature quadrature Kalman filter,” IET Signal
Process., vol. 7, no. 7, pp. 533-541, Sep. 2013.
[11] I. Arasaratnam, S. Haykin and R. J. Elliott, ”Discrete-time nonlinear
filtering algorithms using Gauss-Hermite quadrature,” in Proc. IEEE, vol.
95, no. 5, pp. 953-977, May 2007.
[12] G. Chalasani and S. Bhaumik, ”Bearing only tracking using Gauss-
Hermite filter,” in Proc. IEEE ICIEA, July 2012.
[13] B. Jia, M. Xin and Y. Cheng, ”Sparse-grid quadrature nonlinear filter-
ing,” Automatica, vol. 48, no. 2, pp. 327-341, Feb. 2012.
[14] B. Jia, M. Xin and Y. Cheng, ”Sparse Gauss-Hermite quadrature filter
for spacecraft attitude estimation,” in Proc. IEEE ACC, July 2010.
463
Authorized licensed use limited to: INSTITUTO MILITAR DE ENGENHARIA. Downloaded on September 01,2022 at 13:02:49 UTC from IEEE Xplore. Restrictions apply.