Estimation Introduction
Estimation Introduction
5.1 INTRODUCTION
This chapter covers the concepts of parameter estimation, target tracking, and
data association algorithms used to enable multiple-target tracking in real-world
environments. References [1] through [4] are excellent sources of additional in-
formation on tracking. The topics covered in this chapter include:
97
98 Chapter 5
x = E{ x z } , (5.1)
where x is the parameter being estimated and z are observations from which es-
timates of x can be extracted. It is assumed that x is observable in the control the-
ory sense, that is, that quantities necessary to estimate x are included in a linear
fashion in measurement z.
Estimation, Tracking, and Data Association 99
E{ x− x } = E{ x } = 0 , (5.2)
and
E { ( x − x ) } = E { x } = σ
2 2
x
2
. (5.3)
σ CRB
2
=
( ∆x ) 2 , (5.4)
N SNR
sition, track waveforms are transmitted to the target, target echoes are received,
these measurements are associated with current targets, the target state vectors
are updated using the new measurement, the state vector is predicted to the time
of the next track update, and this information is used to steer the antenna start-
ing the process again. This functional sequence is referred to as a tracking loop,
and executing it is referred to as closing the track loop.
The two major sub-functions that comprise the radar tracking function are the
data association algorithm and the tracking filter. The remaining functions in
Figure 5.1 are performed by the radar scheduler (schedule the track waveform
and steer the antenna), the radar transmitter (transmit the track waveform), and
the receiver (receive the target echo).
The waveforms and signal processing associated with the tracking function
are as follows. First, narrowband waveforms are used for tracking, that is, radio
frequency bandwidths in the range of 5 to 50 MHz. The signal processing per-
formed is the standard pulse matched filtering, followed by range and ampli-
tude interpolation and peak detection. Monopulse processing is used to estimate
target sine space angles u and v. For cases of low-elevation tracking, multipulse
waveforms and processing are employed (e.g., MTI or pulse-Doppler) to miti-
gate clutter backscatter effects.
The subsequent sections in this chapter are devoted to describing the tracking
filters, data association algorithms, and the specific tracking of air, ballistic mis-
sile, and surface targets. However, first the subject of the coordinate systems and
transformations between them will be discussed briefly in the next section.
Estimation, Tracking, and Data Association 101
mentations use the least data processing throughput per tracked target. The
most common of these are the α – β and α – β – γ or alpha-beta and alpha-beta-
gamma filters. The mathematical forms are:
T
x x α k +1 0 x
x = z −
k +1 + , (5.5)
k +1 x k 0 β k +1 x
and
T
x x α k +1 0 0 x
x
= z k + 1 − x 0 β k + 1 0 + x , (5.6)
x k + 1
x k
0
0 γ k + 1 x
where z is the measurement vector at the k + 1 sample time, and α, β, and γ are
the fixed or precomputed weights for sample time k + 1. As can be seen, since
only a small number of adds, subtracts, and multiplies are required for each
track update, the computational requirements for these filters are small.
5.4.2.1 Kalman Filters. There are many forms of computed-gain tracking filters.
However, the most common and widely used is the Kalman filter (KF) type.
These filters are in the statistical filtering class, that is, they embody dynamical
models of the specific target motion and use these to propagate the expected-
value of the state estimates and the covariance matrix of the estimation errors.
The gain computations are where the Kalman filters incur the majority of neces-
sary computations. The state vector update equations are very similar to those in
equations (5.5) and (5.6).
The Kalman filter, references [1] through [4], is the optimal filter if the target
dynamics and the measurement-to-state relationships are linear. If one or both of
these relationships are nonlinear, then the Kalman filter is the optimal linear fil-
ter. Theoretically, an optimal nonlinear filter does exist; however, there is no sys-
tematic method to determine its form. Hence, this is the reason that some form
Estimation, Tracking, and Data Association 103
of the Kalman filter is used in many if not most target tracking applications. In
most cases, due to the non-linearities mentioned above, a special form of the
Kalman filter is used in these cases. It is referred to as the Extended-Kalman fil-
ter (EKF). The EKF is a Kalman filter matched to linearized version of the equa-
tions of state dynamics and observations.
The fundamental concept behind the Kalman filter is the minimization of the
estimation error in the mean-squared sense, and so the Kalman filter is often re-
ferred to as a minimum mean-squared estimate (MMSE). Figure 5.2 is a flow-
chart of the sequence of computations required to implement one track update
and prediction of the target state and error covariance matrix.
It should be noted that the Kalman filter is a recursive estimator, that is, it up-
dates its estimates upon receipt of each new measurement. To illustrate the idea
of recursive estimation, consider the problem of recursive estimating the arith-
metic mean of a sequence of values. Figure 5.3 shows the estimation sequence.
In a similar fashion the Kalman filter’s recursive formulation can be derived.
This is shown in Figure 5.4. This class of filter is often referred to as a predictor-
corrector form, as indicated in Figure 5.4d.
Practical tracking issues that the Kalman filter does not handle include:
gle Kalman filter, where M is the number of target models employed. The de-
tailed filtering logic is described in the following paragraphs.
The steps of the IMM approach are given below.
Each EKF is reinitialized with a composite state and covariance whose con-
stituent components are weighted by the conditional probability that the tar-
get is transitioning to the particular model.
( k − 1)
π ji µ (jk −1)
µ = , where
j |i
µi( k , k −1)
M
µ ( k , k − 1)
i
= ∑ π ji µ (jk −1) is the total probability of being in model i,
j =1
πij is the a priori Markov transition probability that the target is transitioning
from model i to model j, and M is the number of models.
The states and covariance matrices are mixed using the conditional proba-
bilities for each respective model as weights.
M
x (i )
= ∑ µ (jk|i −1) x (j
k − 1, k − 1 k − 1, k − 1)
, is the state used to reinitialize the ith model.
j =1
M
Pi( )
= ∑ µ (jk|i −1) Pi(
k − 1, k − 1)
+ ∆P(ji
k − 1, k − 1 k − 1,k − 1)
, is the covariance matrix used
j =1
to reinitialize the ith model, where:
Update the state and covariance of all EKFs using the new measurement z k
for the (k + 1)th innovation.
The composite state and covariance matrix are blended based on the poste-
rior probability for each model, given below:
M
µi( k , k −1) = ∑ π ji µ (jk −1) is the total probability of model i calculated in step 1.
j =1
1
Li = exp( −ξi2 / 2) is the likelihood of the target being in model
( 2π )
m
Si
i, and
ξi2 = yiT Si−1 y i is the chi-square statistical distance of the measured state
from the predicted state.
y = z k − H k ( x k , k −1 ) ,
Si = H k Pk , k −1 H kT + R ,
4. Estimate Fusion
This step produces the output of the tracking system used to determine the
associated measurement.
Estimation, Tracking, and Data Association 113
M
x ( ) = ∑ µi( k ) x (i ) , is the state used to reinitialize the ith model.
k ,k k ,k
i =1
M
(k ,k )
= ∑ µi( k ) Pi( ) + ∆Pi( ) is the covariance used to reinitialize the ith
k ,k k ,k
P
i =1
model, where the term:
The output of the IMM tracking system is the composite state and covari-
(k ,k ) (k ,k )
ance x ,P , which are used in the association algorithm to de-
Composite
termine the measurement for the next innovation.
There are two fundamental classes of data association algorithms: (i) Non-Baye-
sian, and (ii) Bayesian approaches. These will be discussed in the following sec-
tions.
( Rtrack − Rmeasured ) 2 +
(θtrack − θ measured ) 2 +
(φtrack − φmeasured ) 2 ≤ D , (5.7)
σ R2 σ θ2 σ φ2
where the sum of normalized squared-errors in range, azimuth angle, and eleva-
tion angle, for example, is compared to a threshold and the track yielding the
smallest of those sums for a given target measurement vector compared to the
track state vector quantities would be updated using that measurement. This
process is repeated for all measurements.
If the sum in equation (5.7) exceeds the threshold, D, then no measurement-to-
track assignment is made, since exceeding D corresponds to a very small proba-
bility of correct target-to-track association. If the errors (differences in the nu-
merators) in equation can be modeled as zero-mean Gaussian random variables,
then the sum results in a chi-square distribution with three degrees-of-freedom.
This allows D to be calculated to edit associations with any arbitrary probability
of false association. When using a Kalman-type filter, the estimation error vari-
ances in the denominators can be obtained from the filter’s computed error co-
variance matrix.
At each step in the association process, the PDA computes probabilities of cor-
rect measurement-to-track association for each measurement-track pair. The pair
with the highest probability determines the assignment of that measurement.
This process is repeated for all measurements. The detailed equations and pro-
cessing logic are provided in detail in references [1] through [3] and will not be
repeated here.
Although the algorithms described in Sections 5.1 through 5.5 are commonly im-
plemented techniques for data association, there exist many other approaches,
and more continue to be developed. Table 5.1 is a partial listing of current tech-
niques, including other data association algorithms other than those previously
discussed compiled by F. Daum [3, 8, 9, 10].
As can be seen, the algorithms are rated based on a number of performance
criteria, including:
Time horizon
Considered Number of Data Unsolved Data
(no. of Association Modeled in Unresolved Resolved Exact Approximate
Algorithm Samples) Hypotheses Algorithm Data Data Solution Solution
• Manned aircraft
• Helicopters
• Cruise missiles.
π 11 π 12 0 0
0 π 22 π 23 0
Π= , where
0 0 π 33 π 34
0 0 π 43 π 44
• Object separations
• Gravity turn
• Boost cessation.
After the missile reaches apogee and enters the descent portion of its flight, ad-
ditional phases of flight are:
Use of an IMM tracking filter for ballistic missile targets is illustrated in Figure
5.8. The transition probabilities used in the IMM filter allow a well-organized
method of adding a priori knowledge of the target trajectory characteristics to be
incorporated into the tracking system. As missiles transition from boost to ballis-
tic, ballistic to reentry, and eventually transition from reentry to a possible ma-
neuver and back to reentry a number of distinct state transitions can be defined.
The associated dynamical models are described in Table 5.2. Possible target state
transitions are given in the following transition matrix.
π 11 π 12 0 0
0 π 22 π 23 0
Π= , where
0 0 π 33 π 34
0 0 π 43 π 44
Figure 5.9 illustrates the track transitions with a state transition diagram. The envi-
ronment in which ballistic missile target tracking occurs is much more challenging
than for air target tracking due to the large number of possible closely spaced ob-
jects associated with the missile complex under track. Figure 5.10 illustrates a sim-
plified view of the source multiple objects to be tracked in this environment.
Boosting object within Earth’s Acceleration, drag, and gravity Missile acceleration during
atmosphere are modeled boost, drag parameters, and
missile mass
Ballistic object within Earth’s Drag and gravity are modeled Missile drag parameters, mas,
atmosphere and velocity at booster burnout
(Vbo)
Ballistic object outside Earth’s Gravity is modeled Missile mass, and velocity at
atmosphere exit of Earth’s atmosphere
Estimation, Tracking, and Data Association 123
Figure 5.9 Possible State Transition Diagram for Ballistic Missile Targets
5.9 REFERENCES
[1] Y. Bar-Shalom, Multitarget/Multisensor Tracking: Applications and Advances, Artech
House, 2000
[2] Y. Bar-Shalom & X. Li, Multitarget-Multisensor Tracking, YBS, 1995
[3] S. Blackman & R. Popoli, Design and Analysis of Modern Tracking Systems, Artech
House, 1999
[4] E. Brookner, Tracking and Kalman Filtering Made Easy, Wiley-Interscience, 1998
[5] A. Gelb, Applied Optimal Estimation, MIT Press, 1974
[6] S. Haykin & A. Steinhardt, Adaptive Radar Detection and Estimation, Wiley-Inter-
science, 1992
[7] H. Van Trees, Detection, Estimation and Modulation Theory, Part 1, Wiley-Interscience,
2001
[8] F. Daum, “A System Approach to Multiple Target Tracking,” Chapter 6 in Multi-Tar-
get Multi-Sensor Tracking, Volume II, edited by Yaakov Bar-Shalom, Artech House
1992
[9] W. Koch & G. van Keuk, “Multiple Hypothesis Track Maintenance with Possibly
Unresolved Measurements,” IEEE Transactions on Aerospace & Electronic Systems, Vol.
33, pages 883–892, 1997
[10] F. Daum, “Book Review: Multiple Target Multisensor Tracking,” IEEE AES Systems,
September 1996