Академический Документы
Профессиональный Документы
Культура Документы
GENOVESE
INTRODUCTION
The performance of a tracking system is governed multiple filter models to account for varying target
by the performance of the state estimation algorithm behavior. Efficient management of the multiple filter
employed. Accurate state estimation of targets in a models is critical to limiting algorithm computations
tracking system is required for reliable data association while achieving the desired tracking performance. This
and correlation. The states to be estimated are typi- requirement is achieved with the interacting multiple
cally the kinematic quantities of position, velocity, and model (IMM) algorithm.1
acceleration. Filters are used on measurements to reduce The IMM algorithm is a method for combining state
the uncertainty due to noise on the observation and hypotheses from multiple filter models to get a better
to estimate quantities not directly observed. The filter state estimate of targets with changing dynamics. The
uses a model of the state process that can be used to filter models used in the IMM for each state hypothesis
accurately predict the behavior of the observed target to can be selected to match the behavior of targets of inter-
estimate the desired kinematic quantities. est. Model management for the IMM algorithm is gov-
State estimation of potentially maneuvering targets erned by an underlying Markov chain that controls the
from sensor measurements often requires the use of switching behavior among the multiple models. For the
614 JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001)
INTERACTING MULTIPLE MODEL ALGORITHM
resulting algorithm, logic decisions are not required for targets. These systems require the detection of the target
estimation of the model probabilities.2,3 maneuver via a second estimator and decision-directed
logic to change gains. The problems with this system
BACKGROUND are that the decision to switch can be delayed as a
State estimation for tracking is most effectively done result of lags in the maneuver detection filter and false
by modeling the target trajectory as a linear system. The alarms can give false maneuver indications. In addition,
discrete-time state representation of a linear system is a single state estimator will exhibit biases when the
given in the following equation: model is not matched to the target motion.
Multiple filter models enable a tracking system to
Xk + 1 = kXk wk , better match changing target dynamics. This will yield
the best overall performance on the maneuvering and
where Xk is the state estimate, k is a state transition nonmaneuvering time intervals of targets. The effective
matrix from time k to k + 1, and wk is system process application of multiple models requires an algorithm
noise assumed to be Gaussian-distributed zero mean and to manage the models. Desired performance must be
white. weighed against system resources. The IMM algorithm
Observations for this process are assumed to be linear has been shown to be a very efficient implementation of
with respect to the state estimate. The observations are the multiple model approach.1
then given as The IMM Algorithm
yk = HkXk + vk , The IMM algorithm is a method for combining state
hypotheses from multiple filter models to get a better
where Hk is the matrix relating the state to observation state estimate of targets with changing dynamics. The
quantities and vk is observation noise assumed to be filter models used to form each state hypothesis can be
Gaussian-distributed zero mean and having zero cross derived to match the behavior of targets of interest.
correlation with the process noise wk. Figure 1 shows the flow diagram for an IMM algorithm
The Kalman filter provides the minimum mean with two filter models. Superscripts in the state vari-
squared error solution to this linear system problem ables represent the model hypotheses (1 and 2), and the
when the process under observation is completely rep- symbols ^ and ~ are used to represent filtered and pre-
resented by the state model.4 The equations used to pre- dicted quantities, respectively.
dict and update the state and covariance for a Kalman The state estimates for each model from the previ-
filter are given as follows: ous cycle, X̂1 and X̂ 2, are mixed prior to state update
using a set of conditional model probabilities. The con-
ˆ
˜ = X
X ditional model probabilities (˜ ij ) are computed using
˜ ˆ
P = P T + Q the model probabilities from the previous update and a
˜ T ( HPH
K = PH ˜ T + R) −1
ˆ =X
X ˜ + K( y − HX
k
˜)
X1 X2
ˆ = ( I − KH) P˜ ,
P
~
µ
State interaction
where Z1
X01
Z2
X02
X = the state estimate, µ
P = the covariance matrix, Filter Filter
Μ1 Μ2
~, ^ = the predicted and filtered quantities,
Λ2
respectively, Model
probability
= the discrete time state transition matrix, Λ1 update
Q = the process noise matrix,
K = the Kalman gain,
R = the covariance of the measurement quantity, State
I = an identity matrix, estimate
combination
yk = the measurement quantity used to update the
state estimate, and
T = the matrix transpose operation.
X1 X2 µ X
Most tracking systems employ a single filter model Figure 1. A block diagram of the IMM algorithm with two filter
with adaptive gains for state estimation of maneuvering models.
JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001) 615
A. F. GENOVESE
lihood (i) for each filter model is computed during
the state update from the innovations (Zi) and inno-
vations covariance matrix. The likelihood, prior model where
probabilities, and state switching matrix are then used
Z j = mo − m ˜j
to update the model probabilities. The estimates from
S˜ = H P˜ ( H j ) T + R ,
j j 0 j
each filter model are combined as a weighted sum using
the updated model probabilities.
The equations governing the IMM algorithm for an
arbitrary number of filter models, N, are outlined in the where mo is a vector of observations for the current
following steps. The process then begins with the com- update and m̃ j is the predicted track state for filter
puted quantities from the previous filter iteration. Ini- model j transformed into the frame of the observations.
tialization procedures are required to obtain the state The model probabilities are updated after all filter
estimate, covariance, and initial probabilities for each models have been updated as
filter model.
1
ˆj = j j
c
c
State Interaction
Prior to the filter update, the model state estimates with
and covariances are mixed using computed conditional N
model probabilities. The mixed state and covariance for c = ∑ i c i ,
model j at time k is computed as i =1
ˆ0j =
N where ̃ j is the updated model probability for model j
∑ Xˆi ˜
ij
X
i =1
and c is a normalization constant. Note that innovations
covariance matrix S̃ j is computed using the predicted
and covariance matrix P̂ 0 j.
( )( )
N T
ˆ0 j =
∑ ˜i j Pˆ i + Xˆi − Xˆ j Xˆi − Xˆ 0 j
0
P ,
i =1
State Estimate Combination
The combined state estimate and covariance is com-
where puted from the updated filtered states from each model
weighted by the updated model probabilities:
1
˜i j = p ij ˆ i N
j ˆ = Xˆiˆ i
X ∑
i =1
with
and
N
j ij i
= ∑p , [ ]
N
ˆ = ˆ i P
P ∑ ˆ i + ( Xˆ i − Xˆ)( Xˆ i − Xˆ) T .
i =1
i =1
616 JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001)
INTERACTING MULTIPLE MODEL ALGORITHM
JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001) 617
A. F. GENOVESE
618 JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001)
INTERACTING MULTIPLE MODEL ALGORITHM
RESULTS 80
CV
The simulation results for each filter model are 70
CA
CV-CV
obtained from Monte Carlo simulations with 100 real- CV-CA
izations. The RMS errors for position and velocity 60 CV-CA-TURN
for the weaving target. This plot shows the relative per- 0
TURN
formance of each filter model during the nonmaneuver- 0 20 40 60 80 100 120 140 160
Time (s)
ing period (<60 s), as well as the magnitude of the errors
during the weave. Although the IMM does not reduce
Figure 3. The average model probabilities for the CV-CA-TURN
errors during the weaving period, the performance is IMM on the weaving target. The model probabilities are averaged
not degraded from any single model. Figure 3 shows over 100 Monte Carlo realizations.
JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001) 619
A. F. GENOVESE
80
the CV-CV filter to the CV-CA filter model. This plot
shows the short-duration increase in errors following
60 the target maneuver for the CA and CV-CA-TURN
models. The peaks of these errors are reflected in row
40 10 of Table 3. Shown in Figure 7 are the average model
probabilities for the CV-CA-TURN IMM on the 5.6-g
20
constant-speed turning target. These model probabili-
ties reflect the correct selection of each filter model for
the target duration that yielded the best overall error
0
0 10 20 30 40 50 60 70 80 90 100 performance.
Time (s) In general, the filter performance improved, with
respect to RMS errors, as the complexity of the filter
Figure 4. The filtered RMS velocity errors for the 10-g linear- models increased. The CV filter model could not achieve
speed accelerating target plotted as a function of time for each
of the five filtering methods. Note that the maneuver occurs from the same variance reduction on nonmaneuvering tracks
60 to 70 s. as the IMM filters because its q value was selected high
620 JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001)
INTERACTING MULTIPLE MODEL ALGORITHM
80
IMM FILTER
60 Design parameters for the IMM filters are selected to
control filter operating characteristics such as gain and
40
response to maneuvers. The required design parameters
for the filtering methods defined in the performance
comparison are the IMM state switching matrix ()
20
and the filter model q values.
Figure 7. The average model probabilities for the CV-CA-TURN 120
IMM on the 5.6-g constant-speed turning target. The model prob- Π = [0.95 0.05; 0.12 0.88]
abilities are averaged over 100 Monte Carlo realizations. Π = [0.80 0.20; 0.05 0.95]
100 Π = [0.60 0.40; 0.60 0.40]
JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001) 621
A. F. GENOVESE
Bearing gain
q = 10
moderate changes to the state switching matrix will 0.3
effect small changes to the filter performance. The larg-
est effects are seen during the nonmaneuvering periods q=1
0.2
when the total error is dominated by state noise. In gen-
q = 0.1
eral, the performance of the IMM appears to be rela-
tively insensitive to the selection of the state switching 0.1
q = 0.01
matrix.
0
0 20 40 60 80 100 120 140 160
Process Noise Selection Time (s)
The filter models defined for the filter performance
comparison use process noise as a selected filter input Figure 9. Single CV Kalman filter bearing position gains as a
function of time on a nonmaneuvering target. The four curves rep-
to control the steady-state gains. The process noise is resent different levels of input process noise.
defined by a single selectable parameter specified as the
q value. The relationship between the q value and
steady-state Kalman filter gains is known. Reference 9 0.6
provides closed form expressions for the CV process
noise model. Small q values yield small gains that pro- 0.5
vide good measurement noise reduction but lead to large
lags during maneuvers. Large gains provide little noise
0.4
reduction but give a better lag response during maneu-
Bearing gain
q = 10
vers. Conceptually, a multiple model filter algorithm
0.3
could use two filters, one at each extreme of the gain q=1
q = 0.1
spectrum, and the algorithm would select the proper q = 0.01
balance between the two filters. This is not true for the 0.2
622 JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001)
INTERACTING MULTIPLE MODEL ALGORITHM
80
Results indicate that variations in the model parameters
will effect small changes in the performance of the filter
60
algorithm. Parameter selection needs to be considered
to optimize the performance of an IMM given the com-
40 ponent filter models. Selection of the component filter
models should be the primary consideration for design of
20 an IMM since the best overall performance is achieved
when a filter model is matched to the target kinematics.
0
0 20 40 60 80 100 120 140 160
Time (s) REFERENCES
1Bar-Shalom, Y., Chang, K. C., and Blom, H. A. P., “Tracking a
Figure 11. The filtered RMS velocity errors using a CV-CV IMM
filter model with three different sets of input process noise plotted Maneuvering Target Using Input Estimation Versus the Interacting
as a function of time for the 5.6-g constant-speed turning target. Multiple Model Algorithm,” IEEE Trans. Aerosp. Electronic Syst.
EAS-25(2), 296–300 (1989).
2Blackman, S. S., and Popoli, R., Design and Analysis of Modern Track-
ing Systems, Artech House, Norwood, MA, pp. 221–240 (1999).
3Yeddanapudi, M., Bar-Shalom, Y., and Pattipati, R., “IMM Estima-
CONCLUSIONS tion for Multitarget-Multisensor Air Traffic Surveillance,” Proc. IEEE
The comparative results for five filter models on a 85(1), 80–94 (1997).
4Brown, R. G., and Hwang, P. Y. C., Introduction to Random Signals and
variety of maneuvering targets show that methods that Applied Kalman Filtering, Wiley, New York, pp. 230–236 (1992).
use the IMM algorithm provide the best overall results 5Castella, F. R., “Multisensor, Multisite Tracking Filter,” IEE Proc.
with respect to filtered position and rate errors. The per- Radar, Sonar Navigation 141(2), 75–82 (Apr 1994).
6Castella, F. R., Upgrading to a 9-State EKF for TBM Tracking, F2A-
formance improvement of the IMM is dependent on 96-0-021, JHU/APL, Laurel, MD (9 May 1996).
having filter models that are well matched to the target 7Blair, W. D., Watson, G. A., and Alouani, A. T., Use of Kinematic
behavior. The filter model that is best matched to the Constraint for Tracking Constant Speed Maneuvering Targets, NAVSWC
TR 91-561, Naval Surface Warfare Center, Dahlgren, VA (1991).
target dynamics will provide the best state estimates 8Watson, G. A., and Blair, W. D., “IMM Algorithm for Tracking Tar-
and will have the highest probability. Results presented gets That Maneuver Through Coordinated Turns,” SPIE—Signal and
here also show that behavior of the IMM algorithm Data Processing of Small Targets 1698, 236–247 (1992).
9Ekstrand, B., “Analytical Steady State Solution for a Kalman Track-
is robust when none of the filter models matches the ing Filter,” IEEE Trans. Aerosp. Electronic Syst. AES-19(6), 815–819
target dynamics. The overall IMM performance will at (1983).
THE AUTHOR
JOHNS HOPKINS APL TECHNICAL DIGEST, VOLUME 22, NUMBER 4 (2001) 623