Documente Academic
Documente Profesional
Documente Cultură
__________________________________________________________________
Abstract An alternate computer algorithm using Kalman filtering techniques and spectral factorization
method is discussed to obtain analytical solutions for the optimum steady state position and
velocity estimates of an aircraft moving with a random acceleration perturbing its motion from
its straight line path. The position of the aircraft is assumed to be measured by a track-while-scan
radar sensor at uniform sampling intervals of time T seconds and all measurements are assumed
to be noisy.
Words for Indexing: Kalman filter, track-while-scan radar sensor, Aircraft tracking, Spectral
factorization method
__________________________________________________________________
1.1. Introduction
In [1], Friedland has discussed a one-dimensional dynamic model with piecewise constant
acceleration assumed, to obtain expressions for aircraft position and velocity accuracy before and
after measurements using Kalman filtering techniques. The method employed by Friedland is to
directly solve the algebraic Riccati equations in the steady state. This involves solving three
highly nonlinear equations to obtain the results. In this paper, the problem is treated by using the
spectral factorization method to obtain simpler solutions.
1.2. Dynamic Model
In the one-dimensional dynamic model, as it is assumed that each position coordinate is
measured independently, each coordinate is uncoupled from the other two and can be treated
separately. Thus, for each coordinate, the dynamics of the aircraft is assumed to be described by
the vector matrix equation of the form
X n1 X n an
...(1)
where
T 2 2
x
1 T
X n n ,
,
0 1
x n
T
X n is the state vector consisting of the aircraft position x n and velocity x n ,
a n is the acceleration acting upon the aircraft and T is the uniform sampling interval between
observations. It is assumed that the acceleration is a random constant between successive
Page 43
observations. This random constant is assumed to be of zero mean and constant variance a2 and
is uncorrelated with the acceleration at other intervals, i.e,
Ean 0
E an2 a2
Ean ak 0 for n k
v n is the random noise corrupting the measurement at scan n with the following statistical
properties
Evn 0
E vn2 x2
Evn vk 0 for n k
and
H 1 0
n 1
1
~
~
K n Pn H T HPn H T Rn
~
Pn1 FPn F T Q T
~
Pn I K n H Pn
(4)
~
X n X n is the optimum estimate of the state vector after (before) the measurement is processed,
K n is the Kalman gain matrix,
~
P P is the covariance matrix of estimation errors after (before) the measurement is processed
n
Page 44
~
~
K PH T HPH T R
~
P FP F T Q T
~
P I KH P
(5)
g 2 k 2T
(6)
(7)
Then from the spectral factorization method [2], it can be shown that
g1 1
g2
r 1
r 1
4
r 1
(8)
where
r 1 1 r1 r2
r 1 1 r1 r2
(9)
4 x
aT 2
r12 1 2r2
(10)
~
1.6. Steady State P Matrix
I KH 1 P~ P~T
Q T (11)
~
Let the P matrix be defined as
Page 45
~
~
p
~ p
(12)
P ~11 ~12
p12 p 22
Then the normalized covariances may be defined as
~
p
~
y11 2 11 4
aT
~
p
~
y12 212 3
aT
~
p
~
(13)
y 22 2 22 2
aT
Then from (11) and (13), the normalized covariances may be derived as
r r 1
~
y11 1
8
r
1
~
y12
4
1 r1
~
y 22
2
(14)
(15)
p
P 11
p 12
p 12
p 22
(16)
y11
y12
y 22
p 11
a2T 4
p 12
a2T 3
p 22
a2T 2
(17)
Then from (15) and (17), the normalized covariances may be derived as
Page 46
r1 r 1
8
r 1
y12
4
r1 1
y 22
2
y11
(18)
Thus, all the filter parameters are functions of only one dimensionless quantity r2 . Hence for
different values of the dimensionless parameter r2 , the normalized covariances and gains may be
evaluated from (14), (18) and (8). For example, for r2 10,100,50 and 0.5 the computer results
may be found as given below:
Example. 1.
Computer Results
Parameter
r2 10
~ 8.9260 3.8956
Y
3.8956 2.7913
3.6760 1.6044
Y
1.6044 1.7913
0.5882
g
0.2567
Example 2.
Computer Results
Parameter
r2 100
~ 204.1153 28.7944
Y
28.7944 7.5887
153.8653 21.7056
Y
21.7056 6.5887
Page 47
0.2462
G
0.0347
Example 3.
Computer Results
Parameter
r2 50
~ 76.6930 15.2625
Y
15.2625 5.5249
51.4430 10.2375
Y
10.2375 4.5249
0.3292
G
0.0655
Example 4.
Computer Results
Parameter
r2 0.5
~ 0.5152 0.7286
Y
0.7286 1.2071
0.0152 0.0214
Y
0.0214 0.2071
0.9706
G
1.3726
These values of normalized gains and covariances are in excellent agreement with those values
obtained from the recursive Kalman filter matrix equations (5) for the normalization given by
(7), (13) and (17), thus validating the derivation of results
Page 48
The steady state restriction is removed so that optimum results are obtained even during
start-up transients
.
3.
4.
5.
Measurements may be treated whenever they become available (not necessarily at a constant
rate) and may consist of any function of the state variables.
6.
Large number of state variables may be handled in a straight forward way (although with
increased computational cost).
7.
A by-product of the filter computations are the generation of a covariance matrix which
provides a statistical measure of performance in the form of variances and covariances of the
estimation errors.
Acknowledgements
The author is indebted to Dr. K.V.Ramachandra for his valuable Guidance.
References
[1] B.Friedland, Optimum Steady State Position and Velocity Estimation Using Noisy Sampled
Position Data IEEE Transactions on Aerospace and Electronic Systems, Vol.AES-9, No.6, Pp
906-911, November 1973
[2] M.Beuzit, Analytical Steady State Solution for a Three State Kalman Filter, IEEE
Transactions on Aerospace and Electronic Systems, Vol.AES-25, No.6, Pp 828-835,
November 1989
[3] K.V.Ramachandra, Optimum Steady State Position, Velocity and Acceleration Estimation
Using Noisy Sampled Position Data, IEEE Transactions on Aerospace and
Electronic Systems, Vol.AES-23, No.5, Pp 705-708, September 1987
[4] K.V.Ramachandra, Estimation of Optimum Steady State Position, Velocity and Acceleration
Using Noisy Sampled Position Data, Electro Technology (India), Vol.-23,
No.5, Pp 53-59, September 1979
Page 49
[5] K.V.Ramachandra, Kalman Filtering Techniques for Radar Tracking, Marcel-Dekker Inc.,
New York, 2000
Page 50