IET Radar Sonar Navi - 2015 - Jin - Switched Kalman Filter Interacting Multiple Model Algorithm Based On Optimal
IET Radar Sonar Navi - 2015 - Jin - Switched Kalman Filter Interacting Multiple Model Algorithm Based On Optimal
org
Published in IET Radar, Sonar and Navigation
Received on 2nd December 2013
Revised on 16th May 2014
Accepted on 2nd June 2014
doi: 10.1049/iet-rsn.2014.0142
ISSN 1751-8784
Abstract: A manoeuvring target tracking algorithm based on the autoregressive (AR) model is proposed. First, the AR model is
incorporated into the Kalman filter (KF) for target tracking. The closed-form solution of the AR model coefficients is obtained by
minimising the mean-square tracking error, and subject to the polynomial constraint of target motion. Then, based on the AR
model, the proposed algorithm is constructed by combining the KF with the interacting multiple model (IMM) filter, coupled
with the proposed detection schemes for manoeuvre occurrence and termination, as well as for switching initialisation.
Simulations are performed to demonstrate the effectiveness of the AR model, and the proposed algorithm is compared with
the IMM filter and variable-dimension filter in the manoeuvring scenario.
IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209 199
doi: 10.1049/iet-rsn.2014.0142 & The Institution of Engineering and Technology 2015
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
(IMM-AR) deals with the manoeuvring motion. It is virtually and the process noise wCV k is a white Gaussian random
a simplified form of the variable-structure multiple-model process with the covariance matrix [20]
(VSMM) algorithm [16, 17]. The KF-AR and IMM-AR are
CV T T
switched by the proposed detection scheme. A fading T −t
memory average of innovations is utilised to detect the QCV
k = E wCV
k wk = T −t 1 qv dt
manoeuvre onset in KF mode and in the IMM mode 0 1
whether the effective probability of the quiescent model is T 3 /3 T 2 /2
the largest is added to the detection method of manoeuvre = qv (4)
termination. The length of sliding window for detecting the T 2 /2 T
manoeuvre termination is also different from that for
detecting the manoeuvre onset. These methods have given where the parameter qv is the process noise intensity and
facilities for the fast response to the manoeuvre controls the size of the deviations of the predictive velocity
occurrences, and for reducing the false alarm of manoeuvre from the actual one.
terminations.
The rest of this paper is organised as follows. In Section 2, 2.2 Proposed AR model for target tracking
the traditional model and proposed AR model are introduced. The key to target tracking lies in the effective extraction of
Based on the optimal AR model, a switched KF-IMM useful information about the target state from observations.
algorithm for target tracking is proposed in Section 3. A An effective model will certainly facilitate this information
simulation study is presented in Section 4 to show the extraction to a great extent. From Section 2.1, the
effectiveness of the proposed model and algorithm, discrete-time form of differential model can definitely
followed by concluding remarks in Section 5. The depict the target kinematic motion. However, it does not
mathematical derivations of some equations are detailed in have the function of reducing the noise and cannot adjust to
Appendices 1–3. the process and measurement noise intensities adaptively,
which results in the performance reduction to some extent.
2 System model description For this problem, the AR model is utilised to predict the
target state, and on the premise of satisfying the constraint
Considering one-dimensional (1D) tracking scenario, the of target motion the AR model coefficients are obtained in
target model is a discrete-time dynamical motion model of the sense of MMSE.
the form In the AR model, the target state vector is different from
that of the traditional differential model. It includes the
xk+1 = F k+1|k xk + wk (1) ranges from time k to time k − M + 1, which can be written as
T
where xk is the target state at time kT, and T is the sampling k = rk
xAR rk−1 . . . rk−M +1 (5)
interval. For clarity, in the following, the notation T is
omitted, that is, time k means time kT. Fk + 1|k is the state The state transition matrix in the AR model, F AR
k+1|k , is defined
transition matrix, and the process noise wk is a white by
Gaussian random process with covariance matrix Qk.
With the range-only measurements, the measurement ⎡ ⎤
h1 h2 ... hM
vector of target state at time k is given by ⎢1
⎢ 0 ... 0 ⎥⎥
F AR =⎢ . .. .. .. ⎥ (6)
zk = Hxk + vk (2)
k+1|k
⎣ .. . . . ⎦
0 ... 1 0 M ×M
where the measurement matrix H = 1 0 · · · 0 1×K
and K is the dimension of the target state vector. The The AR model coefficients hm (m = 1, 2, …, M ) to be
measurement noise vk is a white Gaussian random process, optimised should satisfy the polynomial constraint of target
independent of wk, with covariance matrix Rk. In the motion [21, 22]
tracking applications, target dynamics are usually modelled
in the Cartesian coordinates, while target measurements are Auk = b (7)
directly available in the polar or spherical coordinate. When
the sensor measurements are converted to the ones in the T
with uk = h1 h2 · · · hM , b = [ 1 0 ··· 0 ]T and
Cartesian coordinate by some measurement-conversion A is a Vandermonde matrix
techniques [19], the target dynamic model can be utilised in
the engineering application. ⎡ ⎤
1 1 ··· 1
⎢1 2 ··· M ⎥
⎢ ⎥
2.1 Traditional discrete-time differential model ⎢ 22 ··· M2 ⎥
A = ⎢1 ⎥ (8)
⎢ .. .. .. .. ⎥
For simplicity, the CV model
is takenT as an example. In (1), ⎣. . . . ⎦
k = rk
the target state is xCV ṙk , where rk is the target 1 2N ··· MN (N +1)×M
range, and the dot notation denotes the differentiation with
respect to time. The state transition matrix is
where M is the number of AR model coefficients, and N is the
highest degree of polynomial used to approximate the range.
1 T
k+1|k =
F CV (3) The derivation of (7) is given in Appendix 1. When M = N +
0 1 1, that is, (7) is a consistent equation [23], the target motion
200 IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209
& The Institution of Engineering and Technology 2015 doi: 10.1049/iet-rsn.2014.0142
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
can also be depicted by the solution of (7) equivalent to
uk = A−1 b (9) minimise
uk
P k|k−1 (1,1)
(13)
as the traditional discrete-time differential model. For subject to Auk = b
example, the AR model of N = 1, M = 2 can exactly
describe the CV motion, which is equivalent to the CV where (Pk|k−1)(1,1) can be obtained from (10b)
model (as shown in the simulation results). Note that when
N and M are given, the vector uk is defined. It cannot adjust P k|k−1 (1,1)
= uTk P k−1|k−1 uk + Qk−1 (1,1) (14)
to the process and measurement noise intensities either.
In the following, the derivation of the optimal AR model is Since uk is also independent of (Qk−1)(1,1), the cost function
given in the framework of KF by the criterion of MMSE. (13) is equivalent to
Owing to the dependence of the AR model on uk, the
Kalman recursive equations are also explicitly dependent on
minimise uTk P k−1|k−1 uk
uk. Specifically uk
(15)
subject to Auk = b
xk|k−1 uk = F k|k−1 uk · xk−1|k−1 (10a)
The optimisation problem (15) is a convex quadratic
P k|k−1 uk = F k|k−1 uk · P k−1|k−1 · F Tk|k−1 uk + Qk−1 programming problem [24]. It can be solved by Lagrange
(10b) multiplier technique [24]. The closed-form solutions of (15)
in the cases of N = 1, M = 4 and N = 2, M = 4 are derived in
Appendix 2.
S k uk = HP k|k−1 uk H T + Rk (10c)
2.3 Consistency of process noise covariance
K k uk = P k|k−1 uk · H T · S −1
k uk (10d)
In the
AR model, the process noise is
wk−1 . . . wk−M +1 ,
T
xk|k uk = xk|k−1 uk + K k uk · zk − Hxk|k−1 uk (10e) k = wk
wAR which is an
independent identically distributed (i.i.d.) zero-mean white
Gaussian sequence with covariance matrix QAR k . Since all
P k|k uk = I − K k uk · H · P k|k−1 uk (10f ) the components of the target state in the AR model are
the ranges, the process noise in AR model represents the
where xk|k − 1 and Pk|k − 1 are the state vector’s a priori estimate stochastic change of the target range. Assume that the
and covariance matrix, respectively. Sk is the innovation changes of the ranges at different sampling intervals are
covariance, and Kk is the filter gain matrix. xk|k and Pk|k are mutually independent, the covariance matrix of process
the state vector’s a posterior estimate and covariance matrix, noise in the AR model is
respectively. I is an identity matrix. AR T
The state vector in the AR model consists of M elements as QAR
k = E wAR
k wk = qr T · I (16)
shown in (5), however, the element we concern about most at
time k is the first one. The corresponding mean-square
tracking error of rk is the element at the first row and first where the parameter qr is the process noise intensity in terms
column of covariance matrix Pk|k. So the objective function of range, and I is an M-dimensional identity matrix.
in the sense of MMSE can be specially expressed as Hence, as to maintain consistency with the process noise
covariance of AR model, another form of the process noise
covariance in the CV model is given by
minimise P k|k
uk (1,1)
(11) 1 1/T
Auk = b QCV = qr T · (17)
subject to k
1/T 2/T 2
where (·)(i, j ) represents the (i, j)th element of the matrix in the Note that it is a little different from the form in (4). Since the
bracket. (Pk|k)(1,1) can be obtained from (10c), (10d) and (10f) velocity in original model is assumed to be a Wiener process
as follows – the integral of white noise [20], while (17) is derived based
on the premise that the process noise is depicted as a white
2 noise process. However, it has no effect on the use of the
P k|k−1 (1,1) CV model, and it is only that the conditions of parameter
P k|k (1,1) = P k|k−1 (1,1) − setting are different. It affords a benchmark for the fair
P k|k−1 (1,1) + Rk (1,1)
comparison between the AR model and CV model in the
Rk (1,1) · P k|k−1 (1,1) simulation. The derivations of (16) and (17) are given in
= Appendix 3 in detail.
P k|k−1 (1,1) + Rk (1,1)
Rk (1,1) 3 Switched KF-IMM algorithm based on AR
= (12) model
1 + Rk (1,1) / P k|k−1 (1,1)
During the past several decades, multiple-model estimation
Since uk is independent of (Rk)(1,1), the cost function (11) is algorithms for target tracking have received extensive
IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209 201
doi: 10.1049/iet-rsn.2014.0142 & The Institution of Engineering and Technology 2015
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
Table 1 Algorithm for the KF based on AR model (KF-AR) 1; di = zi − Hxi|i−1 is the innovation and Si is the
corresponding covariance matrix which is given in (10c).
Initialisation
Under the Gaussian assumption, d Ti S −1 i d i xnd holds where
2
Given M, N with M ≥ N + 2. T
Initial estimate: x 0|0 = z0 z−1 · · · z−M+1 , where
nd denotes the dimension of measurement vector (nd = 1
T herein). As a weighted sum of i.i.d. Gaussian variables, the
z0 z−1 · · · z−M+1 is the range measurements before the
test statistics εk is not chi-square distributed, but by moment
filter start time k = 1;
Initial covariance: P0|0 = R·I, where R is the measurement noise
matching it can be approximately treated as a scaled version
variance; of a chi-square variable, that is, [1]
Process noise covariance: Q0 = qrT·I.
For k = 1, 2, … 1
Step 1. Calculation of transition matrix 1k x2 (19)
Solve the convex quadratic programming problem (15), and 1 + l s·nz
obtain the transition matrix by (6).
Step 2. Predict the target state using AR model with nz = nd(1 + l)/(1 − l). Then the detection of a manoeuvre
Projected estimate: xk|k−1(uk) = Fk|k−1(uk)·xk−1|k−1; is declared if
Projected
covariance:
P k|k−1 u k = F k|k−1 u k · P k−1|k−1 · F Tk|k−1 u k + Q k−1 .
1
Step 3. Update the target state using the measurements 1k . x2 (a) (20)
Compute the gain matrix: Kk(uk) = Pk|k−1(uk)·H T·[HPk|k−1(uk)H T + 1 + l s·nz
Rk]−1;
Updated estimate: xk|k(uk) = xk|k−1(uk) + Kk(uk)·[zk − Hxk|k−1(uk)]; where 1 − α is the level of confidence, which should be set
Updated covariance: Pk|k(uk) = [I − Kk(uk)·H]·Pk|k−1(uk).
Output the target state estimate xk|k, and let k = k + 1, return to
quite high (e.g. 95% or 99%).
Step 1. A reasonable window length should be provided in
advance. If the window length s is too large, it will lead to
the delay of manoeuvre detection. Otherwise, if the window
length is too small, the estimated manoeuvre onset time
attention in the theoretic research and engineering application, may not be reliable. For a fast response to the manoeuvre
which have experienced two generations generally: onset, a relatively small length in terms of the fading factor
fix-structure multiple-model (FSMM) [8–11, 13–15] and l1 is selected as [2]
VSMM [16, 17]. The model sets of FSMM are assumed
unchanged over time, while VSMM algorithms adjust their
1
model sets in real time with the online mode information. s1 = ceil (21)
1 − l1
Model set adaptation for VSMM can be decomposed into
two complementary and closely related tasks: activation of
where ceil (·) stands for the nearest integer greater than or
a set of new models and termination of a subset of the
equal to the value in the bracket.
current model set [16, 17]. However, the computing
complexity of the VSMM algorithms is very huge. In this
section, we propose a tracking algorithm consisting of the 3.2 Manoeuvre tracking and manoeuvre
KF-AR and the IMM-AR, which is virtually a simplified termination detection
form of the VSMM algorithm. The algorithm performs
three main tasks: non-manoeuvre tracking, manoeuvre In Section 3.1, assume that a manoeuvre is declared at time k,
detection and manoeuvre tracking. The KF-AR mode deals the manoeuvre onset time is estimated as k̂ = k − s − 1. A
with the non-manoeuvre motion, whereas the IMM-AR switch from the KF-AR (N = 1) to the IMM-AR is activated
mode handles the manoeuvre motion. at time k̂ and the target estimates and covariance matrices
of the IMM-AR are initialised as follows
3.1 Non-manoeuvre tracking and manoeuvre
x(k|k
i)
= xk̂|k̂ , P (k|k
i)
= P k̂|k̂ (for i = 1, 2, . . . , L) (22)
onset detection
The proposed algorithm utilises the KF-AR of N = 1 for the where L is the model number in IMM-AR, xk̂|k̂ and P k̂|k̂ are
CV motion tracking. The AR model of N = 1 matches with the target estimate and covariance of the KF-AR (N = 1) at
the CV motion, and it can exhibit high efficiency during the time k̂, respectively. The target states from time k̂ to k
target’s CV movements. The algorithm of KF-AR is shown which had been estimated by the KF-AR (N = 1) should be
in Table 1. re-processed by the IMM-AR. The process flow of the
When the KF-AR (N = 1) is working, a detection scheme is IMM-AR estimator is given in Table 2. So as to afford
used to determine the manoeuvre occurrence and the facilities for the combination of the target state, the number
manoeuvre onset time. In line with the VD filter, a of the elements in target state should be identical in every
detection method for the AR model is presented. The AR model. The degree of polynomials and the process
manoeuvre detector is chi-square significance test based. noise intensities should be different to cover the various
Since the occurrence of a manoeuvre can lead to large motions.
innovations for the KF-AR (N = 1), a fading memory The proposed algorithm utilises the IMM-AR for
average of innovations over a sliding window [k–s + 1, k] of manoeuvre tracking. Meanwhile the detection of manoeuvre
length s is utilised as the test statistic termination is undertaken. Since the manoeuvre termination
can result in large innovations for the IMM-AR estimator, a
k fading memory average of innovations over a sliding
1k = r(s) · ls−i d Ti S −1
i di (18) window is also employed as the test statistic. It is similar to
i=k−s+1 the detection of manoeuvre onset, given in (18). Herein, the
innovation is generated by subtracting the predicted state of
where ρ(s) = (1 − l)/(1 − ls + 1), l is the fading factor, 0 < l < the IMM-AR from the measurement. A longer window
202 IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209
& The Institution of Engineering and Technology 2015 doi: 10.1049/iet-rsn.2014.0142
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
Table 2 Algorithm for the IMM estimator based on AR model
(IMM-AR)
IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209 203
doi: 10.1049/iet-rsn.2014.0142 & The Institution of Engineering and Technology 2015
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
Fig. 2 RMSE of estimated range and velocity for CV and AR models (qr = 0)
a Range
b Velocity
Then with the measurements, the velocity can be estimated motion, the optimal AR model outperforms the CV model
by another low-degree AR model. The root-mean-square more evidently.
error (RMSE) comparisons of estimated range and Since the measurement of the AR model for estimating the
velocity for the models in two cases are shown in Figs. 2 velocity is different from that of the CV model, the results
and 3. shown in Figs. 2b and 3b are a little different from the
From Figs. 2a and 3a, it can be seen that the AR model 0 Fig. 2a and 3a. However, it can be seen that the optimal
has the same performance as the CV model, since it is AR model performs better than the CV model.
equivalent to the CV model as mentioned in Section 2.2.
The AR model 0 and CV model can equally depict the CV Case 2: We consider a 2D scene with the fast and slow turn
motion. The optimal AR model (M = 3, 4) performs better manoeuvres in (x, y) plane as in [10]. The target moves
than the CV model in the aspect of estimated accuracy. As with CV unless otherwise stated, and its state evolves with
the AR model (M = 3, 4) cannot only satisfy the constraint the initial state x0 = [21689 m −8.3 m/s 0 m/s2 10840 m
of target motion as the CV model and AR model (M = 2), −340 m/s 0 m/s2]T. The position of the target is sampled at
but also minimise the mean-square tracking error with the every T = 1 s. The measurement noise variance of the x- and
extra degrees of freedom. y-dimensional position is R = 100 m2. During the 25th to
In addition, the longer the length of the AR model 33rd sampling periods, the target makes a fast turn with
coefficient is, the better the tracking performance of the x-axis acceleration 0.3 m/s2 and y-axis acceleration 0.3 m/s2.
KF-AR has. As the longer the length of the AR model During the 52nd to 57th sampling periods, the target makes
coefficients is, the more information the filter can utilise. a slow turn with x-axis acceleration 0.08 m/s2 and y-axis
However, the target may manoeuvre at unknown time in acceleration 0.02 m/s2.
practice, it is suggested that the appropriate length is N + We choose the traditional IMM filter and VD filter to
1 ≤ M ≤ 5. The comparison of Figs. 2 and 3 reveals that compare with the proposed algorithm. In the IMM filter, a
when the parameter setting does not match with the actual CV model and two CA models with different process noise
Fig. 3 RMSE of estimated range and velocity for CV and AR models (qr = 1.0)
a Range
b Velocity
204 IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209
& The Institution of Engineering and Technology 2015 doi: 10.1049/iet-rsn.2014.0142
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
Fig. 4 RMSE of estimated position for VD, IMM and proposed algorithms
a x-axis
b y-axis
covariance matrices are utilised. The process noise covariance Table 3 Data compress ratio against sampling interval when
matrices are, respectively (see (25)), with q1 = 0.01, q2 = 0.1 R = 100 m2
and q3 = 1.0. The derivation of the process noise covariance Algorithm Sampling interval, s
is given in Appendix 3. The transition probability matrix of
the three models is 0.1 0.5 1 2 5
⎡ ⎤
1 1/T 1/T 2
1 1/T ⎢ ⎥
k = q1 T ·
QCV , QCA1
k = q2 T · ⎣ 1/T 2/T 2 3/T 3 ⎦,
1/T 2/T 2
1/T 2 3/T 3 6/T 4
⎡ 2
⎤
1 1/T 1/T
⎢ ⎥
QCA2
k = q3 T · ⎣ 1/T 2/T 2
3/T 3 ⎦ (25)
1/T 2 3/T 3 6/T 4
IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209 205
doi: 10.1049/iet-rsn.2014.0142 & The Institution of Engineering and Technology 2015
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
Table 4 Data compress ratio against measurement noise 4 Bogler, P.L.: ‘Tracking a maneuvering target using input estimation’,
variance when T = 1 s IEEE Trans. Aerosp. Electron. Syst., 1987, 23, (3), pp. 298–310
5 Park, Y.H., Seo, J.H., Lee, J.G.: ‘Tracking using the variable-dimension
Algorithm Measurement noise variance, m2 filter with input estimation’, IEEE Trans. Aerosp. Electron. Syst., 1995,
31, (1), pp. 399–408
52 102 202 302 502 6 Khaloozadeh, H., Karsaz, A.: ‘Modified input estimation technique for
tracking manoeuvring targets’, IET Radar Sonar Navig., 2009, 3, (1),
VD 0.9867 0.9645 0.9451 0.9377 0.9137 pp. 30–41
IMM 0.8512 0.8326 0.8026 0.8023 0.7703 7 Li, X.R., Jilkov, V.P.: ‘Survey of maneuvering target tracking. Part V:
proposed 0.7704 0.7647 0.7314 0.6822 0.6615 multiple-model methods’, IEEE Trans. Aerosp. Electron. Syst., 2005,
41, (4), pp. 1255–1321
8 Mazor, E., Averbuch, A., Bar-Shalom, Y., Dayan, J.: ‘Interacting
multiple model methods in target tracking: a survey’, IEEE Trans.
Aerosp. Electron. Syst., 1998, 34, (1), pp. 103–123
the Monte Carlo runs, which is defined as 9 Fu, X., Jia, Y., Du, J., Yu, F.: ‘New interacting multiple model
algorithms for the tracking of the manoeuvring target’, IET Control
Theory Appl., 2010, 4, (10), pp. 2184–2194
1 Nd Nm
2
h= rk − r̂ki /R (28) 10 Ho, T.J.: ‘A switched IMM-extended Viterbi estimator-based algorithm
for manuevering target tracking’, Automatica, 2011, 47, pp. 92–98
Nd Nm k=1 i=1
11 Foo, P.H., Ng, G.W.: ‘Combining the interacting multiple model method
with particle filters for manoeuvring target tracking’, IET Radar Sonar
where Nm is the number of Monte Carlo runs, Nd is the Navig., 2011, 5, (3), pp. 234–255
12 Jing, L., Vadakkepat, P.: ‘Interacting MCMC particle filter for tracking
number of the data for a Monte Carlo run and R is the maneuvering target’, Digital Signal Process., 2010, 20, pp. 561–574
variance of the measurement noise. The two tables show 13 Boers, Y., Driessen, J.N.: ‘Interacting multiple model particle filter’, IEE
that the integral performance of the proposed algorithm is Proc. Radar Sonar Navig., 2003, 150, (5), pp. 344–349
better than the traditional VD and IMM algorithms on the 14 Laneuville, D., Bar-Shalom, Y.: ‘Maneuvering target tracking: a
same conditions of data rate and measurement noise variance. Gaussian mixture based IMM estimator’. Proc. 2012 IEEE/AIAA
Aerospace Conf., Big Sky, MT, March 2012, pp. 1–12
15 Lan, J., Li, X.R., Jilkov, V.P., Mu, C.: ‘Second-order Markov chain
5 Conclusions based multiple-model algorithm for maneuvering target tracking’,
IEEE Trans. Aerosp. Electron. Syst., 2013, 49, (1), pp. 3–19
In this paper, a switched KF-IMM algorithm based on AR 16 Li, X.R.: ‘Multiple-model estimation with variable structure. Part II:
model-set adaptation’, IEEE Trans. Autom. Control., 2000, 45, (11),
model is proposed for target tracking. First, an AR model is pp. 2047–2060
incorporated into the KF for target tracking. The degrees of 17 Lan, J., Li, X.R., Mu, C.: ‘Best model augmentation for
freedom of the AR model can satisfy the target motion on variable-structure multiple-model estimation’, IEEE Trans. Aerosp.
the one hand, and reduce the noise in the sense of MMSE Electron. Syst., 2011, 47, (3), pp. 2008–2025
18 Li, X.R., Jilkov, V.P.: ‘Survey of maneuvering target tracking. Part I:
on the other hand. Then, a switching mechanism is dynamic models’, IEEE Trans. Aerosp. Electron. Syst., 2003, 39, (4),
employed to adjust to the non-manoeuvring and pp. 1333–1364
manoeuvring motions, combined with the detection scheme 19 Zhao, Z., Li, X.R., Jilkov, V.P.: ‘Best linear unbiased filtering with
of manoeuvre onset and termination. Simulations nonlinear measurements for target tracking’, IEEE Trans. Aerosp.
demonstrate that the AR model has enhanced the tracking Electron. Syst., 2004, 40, (4), pp. 1324–1336
20 Bar-Shalom, Y., Li, X.R., Kirubarajan, T.: ‘Estimation with applications
accuracy and the proposed algorithm has a better to tracking and navigation: theory algorithms and software’ (John Wiley
performance than the VD and IMM filters in the & Sons, 2001)
manoeuvring scene. However, the proposed AR model has 21 Väliviita, S., Ovaska, S.J., Vainio, O.: ‘Polynomial predictive filtering in
some disadvantages as follows: (i) the range and velocity control instrumentation: a review’, IEEE Trans. Ind. Electron., 1999, 46,
(5), pp. 876–888
cannot be obtained synchronously in a single AR model as 22 Xu, L., Li, X.R., Duan, Z., Lan, J.: ‘Modelling and state estimation for
in the traditional differential model and (ii) the coefficients dynamic systems with linear equality constraints’, IEEE Trans. Signal
of the AR model need to be computed in real time, which Process., 2013, 61, (11), pp. 2927–2939
has added to the computing amount a bit. 23 Meyer, C.D.: ‘Matrix analysis and applied linear algebra’ (SIAM, 2000)
In the future work, a manoeuvring target tracking algorithm 24 Singiresu, S.R.: ‘Engineering optimization: theory and practice’ (John
Wiley & Sons, 2009, 4th edn.)
based on the neural network or fuzzy logic are suggested for
further studies.
8 Appendices
6 Acknowledgments 8.1 Appendix 1: derivation of (7)
This work is partially supported by the National Natural It is well known that any continuous target trajectory can be
Science Foundation of China (nos. 61271291 and approximated by a polynomial of a certain degree to an
61201285), Programme for New Century Excellent Talents arbitrary accuracy. As such, it is possible to model target
in University (NCET-09-0630), and the Fundamental motion by Nth-degree polynomial in the Cartesian
Research Funds for the Central Universities. coordinates [18]
7 References ⎡ ⎤
⎡ ⎤ ⎡ ⎤ 1 ⎡ ⎤
x(t) a0 a1 . . . aN ⎢ t ⎥ w (t)
1 Li, X.R., Jilkov, V.P.: ‘A survey of maneuvering target tracking. Part IV: ⎣ y(t) ⎦ = ⎣ b0 ⎢ ⎥ ⎣ x ⎦
b1 . . . b N ⎦⎢ .. ⎥ + wy (t) (29)
decision-based methods’. Proc. SPIE Conf. on Signal and Data ⎣ . ⎦
Processing of Small Targets, Orlando, USA, April 2002, pp. 4728–4760 z(t) c0 c1 . . . cN N
wz (t)
2 Bar-Shalom, Y., Birmiwal, K.: ‘Variable dimension filter for t
maneuvering target tracking’, IEEE Trans. Aerosp. Electron. Syst.,
1982, 18, (5), pp. 621–629
3 Koteswara Rao, S.: ‘Modified gain extended Kalman filter with
with a certain choice of the coefficients an, bn, cn (n = 0, 1,…,
application to bearings-only passive manoeuvring target tracking’, IEE N), where (x, y, z) are the position coordinates and (wx, wy, wz)
Proc. Radar Sonar Navig., 2005, 152, (4), pp. 239–244 are the corresponding noise terms. Such an Nth-degree
206 IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209
& The Institution of Engineering and Technology 2015 doi: 10.1049/iet-rsn.2014.0142
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
polynomial amounts to assuming the Nth time derivative of When n = 2, (35) is
the position is (nearly) constant. The CV and CA models
[18] are special cases (for N = 1, 2, respectively) of this
M
Extracting the like terms (the terms having the same degree), so that (42) can be rewritten as
we have
Auk = b (44)
M
(k + 1) = n
hm (k + 1 − m) , n
n = 0, 1, . . . , N (35)
m=1
8.2 Appendix 2: closed-form solution of
When n = 0, the zero-degree constraint of the AR model optimisation problem (15)
coefficients is obtained from (35)
When N = 1, M = 4, using the method of Lagrange multipliers
M [24], the Lagrange function can be written as
hm = 1 (36)
m=1 4
4
L h1 , h2 , h3 , h4 , l0 , l1 = hi P k−1|k−1 (i,j) hj
i=1 j=1
When n = 1, (35) is # $ # $
4
4
+ l0 hi − 1 + l1 hi i (45)
M
i=1 i=1
k+1= hm (k + 1 − m) (37)
m=1
Setting the partial derivatives of L(h1, h2, h3, h4, l0, l1) with
Using (36) in (37), we obtain the first-degree constraint of the respect to all the arguments equal to zero, we obtain
AR model coefficients
∂L 4
=2 hi P k−1|k−1 (i,j) +l0 + jl1 = 0, for j = 1, 2, 3, 4
M ∂hj
hm m = 0 (38) i=1
m=1 (46)
IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209 207
doi: 10.1049/iet-rsn.2014.0142 & The Institution of Engineering and Technology 2015
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
Note that there is an assumption as mentioned in Section
∂L 4
2.3, which is the stochastic changes of the range at every
= h −1=0 (47) sampling interval are mutually independent, that is
∂l0 i=1 i
∂L 4
= hi=0 (48) cov rk , ri = 0, for i = k (55)
∂l1 i=1 i
The coefficients h1 and h2 are solved from (47) and (48) as Thus the covariance matrix of the process noise in the AR
model is
h1 = h3 + 2h4 + 2, h2 = −2h3 − 3h4 − 1 (49)
AR T
k = E wk
QAR = qr T · I
AR
wk (56)
Substituting (49) to the partial derivatives ∂L/∂hj ( j = 1, 2, 3,
4), we have (see (50) and (51))
T T
where g1 = 1 −2 1 0 , g2 = 2 −3 0 1 and where I is an M-dimensional identity matrix.
T We can also obtain
g3 = 2 −1 0 0 .
Also using the same method, we obtain the solution of
optimisation problem (15) when N = 2, M = 4 r −r
cov rk , ṙk = cov rk , k k−1
T
gT1 P k−1|k−1 g2 + gT2 P k−1|k−1 g1 1
h4 = − , 1
= cov rk , rk − cov rk , rk−1
2 · gT1 P k−1|k−1 g1 T T
h1 = −h4 + 3, h2 = 3h4 − 3, h3 = −3h4 + 1 (52) 1
= cov rk , rk (57)
T T T
where g1 = −1 3 −3 1 , and g2 = 3 −3 1 0 .
and (see (58))
8.3 Appendix 3: derivation of process noise
covariance Thus another form of the process noise covariance in the CV
model can be obtained
According to (4), the error covariance of predicted velocity is
T
cov ṙk , ṙk = qv dt = qv T (53) cov rk , rk cov rk , ṙk
0 QCV
k =
cov rk , ṙk cov ṙk , ṙk
where cov(a, b) denotes the covariance of statistic a and b. 1 1/T
Similarly, the error covariance of predicted range can be = 2 · cov rk , rk
defined as 1/T 2/T
1 1/T
T = · qr T (59)
cov rk , rk = qr dt = qr T (54) 1/T 2/T 2
0
where qr is the process noise intensity in terms of range. In the same way, another form of the process noise covariance
T
2g2 P k−1|k−1 g2 gT1 P k−1|k−1 g3 + gT3 P k−1|k−1 g1 − gT1 P k−1|k−1 g2 + gT2 P k−1|k−1 g1 gT2 P k−1|k−1 g3 + gT3 P k−1|k−1 g2
h3 = T 2 (50)
g1 P k−1|k−1 g2 + gT2 P k−1|k−1 g1 − 4gT1 P k−1|k−1 g1 · gT2 P k−1|k−1 g2
T
2g1 P k−1|k−1 g1 gT2 P k−1|k−1 g3 + gT3 P k−1|k−1 g2 − gT1 P k−1|k−1 g2 + gT2 P k−1|k−1 g1 gT1 P k−1|k−1 g3 + gT3 P k−1|k−1 g1
h4 = T 2 (51)
g1 P k−1|k−1 g2 + gT2 P k−1|k−1 g1 − 4gT1 P k−1|k−1 g1 · gT2 P k−1|k−1 g2
r − r
k−1 rk − rk−1
cov ṙk , ṙk = cov k ,
T T
1
= 2 cov rk , rk − 2cov rk , rk−1 + cov rk−1 , rk−1
T
2
= 2 cov rk , rk (58)
T
208 IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209
& The Institution of Engineering and Technology 2015 doi: 10.1049/iet-rsn.2014.0142
17518792, 2015, 2, Downloaded from https://ietresearch.onlinelibrary.wiley.com/doi/10.1049/iet-rsn.2014.0142, Wiley Online Library on [23/11/2024]. See the Terms and Conditions (https://onlinelibrary.wiley.com/terms-and-conditions) on Wiley Online Library for rules of use; OA articles are governed by the applicable Creative Commons License
www.ietdl.org
in the CA model can be obtained as follows Note that (59) and (60) are derived based on the assumption
⎡ ⎤ that the process noise is depicted as a white noise process,
cov rk , rk cov rk , ṙk cov rk , r̈k which are different from those obtained in Wiener process
⎢ ⎥ [20]. However, they have no effect on the use of models,
k = ⎣ cov rk , ṙ k
QCA cov ṙk , ṙk cov ṙk , r̈k ⎦
and it is only that the conditions of parameter setting are
cov rk , r̈k cov r̈k , ṙk cov r̈k , r̈k different.
⎡ ⎤
1 1/T 1/T 2
⎢ ⎥
= ⎣ 1/T 2/T 2 3/T 3 ⎦ · cov rk , rk
1/T 2 3/T 3 6/T 4
⎡ ⎤
1 1/T 1/T 2
⎢ ⎥
= ⎣ 1/T 2/T 2 3/T 3 ⎦ · qr T (60)
1/T 2 3/T 3 6/T 4
IET Radar Sonar Navig., 2015, Vol. 9, Iss. 2, pp. 199–209 209
doi: 10.1049/iet-rsn.2014.0142 & The Institution of Engineering and Technology 2015