Professional Documents
Culture Documents
IMM Estimator For Maneuvering Target
IMM Estimator For Maneuvering Target
IMM Estimator For Maneuvering Target
Abstract— Target tracking is one of the most important The IMM consists of two models namely, constant
applications of Wireless Sensor Networks (WSN). It is velocity (CV) model and Improved Current Statistical
the state estimation of a moving object based on sensor Model (ICSM). The CV model [1] is also known as white
information. Interacting Multiple Model (IMM) acceleration model since x and y directions are modeled as
estimator is a self adaptable, multiple model filters with white noise. The control input u is the main factor in
less computational complexity where estimation is done maneuvering target tracking. For non maneuvering mode u
by probabilistically integrating different models. This is 0. Constant Acceleration (CA) model is the conventional
paper proposes IMM estimator with Improved Current method used to model maneuvering mode. It assumes
Statistical Model (ICSM). The main feature of this acceleration increment as an independent (white noise)
estimator is ability to track the maneuvering target process. However it cannot provide an accurate estimation
according to its current acceleration so that it can track in highly maneuvering target, because actual maneuvers
accurately as its original motion. IMM is implemented seldom have constant accelerations that are uncoupled
with two models namely Constant velocity (CV) and across coordinate directions. Hence a better model is
ICSM to track the uniform and maneuvering targets required to cope up with the unknown varying target
respectively. The estimator is examined for different acceleration.
motions and simulation result is compared with the Global Positioning System (GPS)-based systems are
traditional IMM estimator. The accuracy of the widely used for tracking applications in WSN. A Sensor
proposed tracking has been validated for missing event node consists of RFID reader and GPS constitute the
cases and different scenarios. Wireless Sensor Network (WSN). However, GPS based
systems provide continuous, accurate, and high integrity
Keywords—WSN, Maneuvering Target, IMM, Improved position data. The integration of GPS data and data from
Current Statistical Model, constant velocity model. Radio Frequency Identifier (RFID) reader provides
necessary information to track a person/object. GPS
I. INTRODUCTION provide information about the location of the sensor in
Target tracking finds a vast application in military and WSN and RFID reader provides information about the
civilian systems. Civilian applications include air traffic, person/object who wears RFID tag.
marine control, navigation, person/object tracking and This paper proposes IMM with Constant velocity (CV)
decision problems. The Kalman Filter (KF) is suitable to and Improved Current Statistical Model (ICSM). The
estimate the state of targets moving with nearly constant name improved implies, the previous state updated
velocity. The single KF is no longer acceptable and will acceleration is used to update the state acceleration matrix
lead to filter divergence when the target starts in ICSM. Here the prior probability density of acceleration
maneuvering, because its acceleration appears as extensive is replaced by conditional probability density. The current
process noise in the target model and the original process probability density of the maneuvering target acceleration
noise variance cannot cover it. The velocity model may not is a modified Rayleigh density which increases tracking
be suitable for maneuvering target and acceleration model accuracy. The results show that the estimation accuracy is
may not be suitable for non maneuvering target tracking. increased by using ICSM.
To precisely predict and estimate the motion information The paper is organized as follows. Section II describes
of targets, the exact models of maneuvering targets should the proposed method. In section III, IMM filter is
be designed. Hence multiple model (MM) filters are presented. Simulation results are shown in section IV.
needed for efficient maneuvering target tracking. The Section V includes conclusion.
Interacting Multiple Model (IMM) estimator, where
multiple models with different structures or process noise II. PROPOSED METHOD
levels are used to describe the motion of the target and the Whenever a person with RFID tag is detected, the
final estimate is obtained by a weighted sum of the location information of the node is sent to the base station
estimates from sub-filters of the different models [1][2][3]. [2]. The block diagram for tracking is shown in the Fig
IMM algorithm selects a model according to the motion 1.The processing system has the IMM filter where
and automatically switches between the models as per the estimation is done.
Markov transition probability matrix [8]. The IMM The target state and measurement equation are
estimator with KF as sub filter is used a set of models to represented by equation (1) and (2) respectively
describe the target model [4][5][6].
x k+1 =F(k+1,k) x k +G k w (1)
Interaction
ª1 T 0 0 0 0º
zk «0 1 0 0 0 0 »»
«
«0 0 0 0 0 0»
F= « » (3)
Non Maneuvering «0 0 0 1 T 0»
Maneuvering case «0 0
case (CV) (ICSM) 0 0 1 0»
« »
¬0 0 0 0 0 0¼
L 1(k ) L 2 (k ) ªT 2 /2 0 º
1
x̂ ( k / k ) 2
x̂ ( k /k ) « »
P 1 (k/k) Update Mode P 2 (k/k)
« T 0 »
Probability « 1 0 »
G= « 2 » (4)
ȝ j (k) « 0 T /2 »
State estimation
« 0 T »
« »
¬« 0 1 ¼»
ª1 0 0 0 0 0º
Estimated output H= « » (5)
¬0 0 0 1 0 0¼
x (k /k ) P (k /k)
287
IMM Estimator for Maneuvering Target Tracking with Improved Current Statistical Model
1 ª -2ĮT 2Į T 3 3
º P 0j (k-1/k-1)= ¦ ȝ i/j (k-1/k-1)P i (k-1/k-1)
q11= 5 «
1-e +2ĮT+ -2Į 2 T 2 -4ĮTe-ĮT » i=1
2Į ¬ 3 ¼ + ª¬ xˆ i (k-1/k-1)-xˆ 0j (k-1/k-1) º¼
1
q12= 4 ª¬1+e-2ĮT -2e-ĮT +2ĮTe-ĮT -2ĮT+Į 2 T 2 º¼ ª¬ xˆ i (k-1/k-1)-xˆ 0j (k-1/k-1) º¼ (12)
T
2Į
1 1
q13= 3 ª¬1-e-2ĮT -2ĮTe-ĮT º¼ Where ȝ i/j (k-1/k-1)= ª¬ pijȝ i/j (k-1) º¼ are mixing
2Į cj
1 probabilities and
q22= 3 ª¬ 4e -ĮT -3-e-2ĮT +2ĮT º¼ r
2Į
cj = ¦ pijȝ i/j (k-1/k-1) is the normalisation factor.
1
q23= 2 ª¬1-2e -ĮT +e-2ĮT º¼ i=1
2Į
1 (ii) Mode Conditioned Filtering
q33= ª¬1-e-2ĮT º¼ The estimate and covariance values are used as input to
2Į
The acceleration matrix is given by equation (9) the Kalman filter matched to m j (k) to obtain state
j j
estimate x̂ (k/k) and covariance P (k/k) at time k.
ª u1 0 º The Kalman filter equations are given in the following
« u2 0 » equations (13) to (19)
« »
« u3 0 »
U= « » (9) xˆ j (k/k-1)=Fj(k-1) xˆ j (k-1/k-1)+G(k-1)w (13)
« 0 u1»
(14)
« 0 u2» Pj (k/k-1)=Fj(k-1) Pj (k-1/k-1)FjT (k-1) +GQ(k)G T
« »
¬ 0 u3¼ z j (k)=z(k)-H j (k)xˆ j (k/k-1) (15)
Where S j (k)=H j (k)Pj (k/k-1)H Tj (k)+R(k) (16)
2 -ĮT -ĮT
T (ĮT-1+e ) (1-e )
u1= - u2=T-
2 Į2 Į K j (k)=Pj (k/k-1)H Tj (k)S-1j (k) (17)
u3=1-e-ĮT
R is measurement noise covariance given by equation (10)
xˆ j (k/k)=xˆ j (k/k-1)+K j (k)v j (k) (18)
ª r 0º Pj (k/k)=Pj (k/k-1)-K j (k)S jK Tj (k) (19)
R= « » (10)
¬0 r ¼ The likelihood function L j (k) is given as
III. IMM FILTER -1/2 1 ½
The IMM filter uses various models [8] to estimate the L j (k)= S j (k) exp ®- z Tj (k)S-1j (k)z j (k) ¾ (20)
target’s state. At each time it switches between the
¯ 2 ¿
constant velocity and improved current statistical model Where S j (k) and z j (k) are j conditioned filter
accordingly. The Kalman filter is elementary filter for covariance and innovation respectively.
these models.
Let r be the number of models constructed in the IMM
filter. Let us assume that the target motion is described by (iii) Mode Probability Update
one of the models at each time. IMM algorithm consists of
the following four steps [3]. The mode probability is updated as
r
1
(i) Interaction ȝ j (k)= L j (k)¦ pijȝ i (k-1) (21)
x̂ 0j (k-1/k-1) and covariance
The mixed initial state c i=1
Where, c is normalisation factor.
P 0j (k-1/k-1) for the filter matched to m j (k) ,
288
IEEE-ICRTIT 2011
2500
(iv) Estimate and covariance combination
The combination of the updated mode conditioned state 2000
y position in metres
x(k/k)= ¦ xˆ (k/k)ȝ j (k)
j
(22)
1000
j=1
r 500
IMM which is used to estimate the next position of the Fig.2 a.CV-ICSM Estimation
target and also to minimize the error in the measurement.
RMSE is calculated for x and y position for both CV-
The predicted state is corrected using the observation.
ICSM and conventional CV-CA and are shown in Fig. 4
IMM state vector X is initialized using the target/person’s
and 5 respectively. The performances of both the methods
current position in x and y coordinates.
are evaluated and their comparisons prove that, the
IV. SIMULATION RESULTS proposed method has less deviation than the other one.
Once the sensors are deployed in the area of interest,
during initialization phase, the sensor id, the location TABLE I. RMSE comparison for CV CA and CV ICSM
information, and its neighbours connectivity details are
available in the server via sink node. When a person is
moving, nodes in that path detect the movement of the
person and send the packet to the sink. The generated x position y position
WSN packet consists of node id, RFID, location and time.
Coordinates X and Y in the location field represent the At T 5s 10s 15s 5s 10s 15s
location of the sensor node that has detected the person.
This information is fed to the IMM filter in the system CV-CA 0.80 1 3.861 1.901 1.399 6.400 6.188
connected to the sink node. To show the effectiveness of
the algorithm, a scenario for tracking a maneuvering target
CV ICSM
is examined. The filter is designed with the following 0.696 1.968 0.779 1.204 2.578 1.164
parameters
Sampling interval T is set to be 1s.
Maneuver correlation coefficient α is 0.1. 140
Prior probability is = [0.85 0.15]. observed
ª0.35 0.65º
CV ICSM estimated
120 CV CA estimated
Transition probability is = « ».
¬0.65 0.35¼ 100
80
Simulation results are obtained from 15 Monte Carlo
runs by varying the measurement noise covariance. 60
The Fig.2 a & b shows the estimation of CV-ICSM for
different trajectory. The error is less in the case of 40
proposed ICSM method than the CV-CA one. It reveals
that even though the target has dynamic motion, the 20
proposed method can track with less error. Fig.3 shows the
switching between Constant Velocity and Improved 10 20 30 40 50 60 70 80
Current Statistical Model for Fig.2 a and it shows that the x position in metres
289
IMM Estimator for Maneuvering Target Tracking with Improved Current Statistical Model
1
At any time no observation is received, the filter can
0.9 able to estimate the state using the previous estimated state.
0.8 A scenario is created with events missing at 5s, 6s, 7s, 14s,
0.7 15s, 16s and 17s and the simulation is done. Fig 6 shows
the IMM state estimation when some events are missing.
mode probability
0.5
Improved current statistical model .
V. CONCLUSION
0.4
0
0 5 10 15 20 25 30 35 depends on current acceleration. The estimated output has
no of samples
less deviation as shown in error plots. It is found from
Fig.3.Mode Probability (CV ICSM) simulation studies that the proposed scheme gives better
20
performance in terms of prediction accuracy for any kind
CV CA of trajectory.
18 CV ICSM
.
16 REFERENCES
14
[1] X. Rong Li and Vesselin P. Jilkov, “A survey of maneuvering target
error in x pos ition(m )
5 10 15 20 25 30 35
no of samples
900
800
700
y position in metres
600
500
400
300
original
200 estimated
100
0
0 100 200 300 400 500 600 700 800 900
x position in metres
290