Open access peer-reviewed chapter

# Tracking of Flying Objects on the Basis of Multiple Information Sources

By Jacek Karwatka

Published: January 1st 2010

DOI: 10.5772/7181

## 1. Introduction

In the paper, a new approach to the estimation of the localization of flying objects on the basis of multiple radiolocation sources has been proposed. The basic purpose of the radiolocation is the detection and tracking of objects. The main task of a tracking system is the estimation and prediction of localization and motion of tracked objects. In the classical tracking systems, the estimation of localization and motion of tracked objects is based on the series of measurements performed by a single radar. Measurements obtained from other sources are not taken directly into account. It is possible to assess the estimate of a tracking object on the basis of the different sources of information, applying, for example, least squares method (LSM). However, such solution is seldom applied in practice, because necessary formulas are rather complicated. In this paper, a new approach is proposed. The key idea of the proposed approach is so called matrix of precision. This approach makes possible tracking not only on the basis of radar signals, but also on the basis of bearings. It makes also possible the tracking of objects on the basis of multiple information sources. Simplicity is the main attribute of proposed estimators. Their iterative form corresponds well with the prediction-correction tracking model, commonly applied in radiolocation. In the paper numerical examples presenting advantages of the proposed approach are shown.

The paper consists of seven parts. Introduction is the first one.

In the second part the idea of the matrix of precision is presented and it is demonstrated how it can be used to uniformly describe the dispersion of measurement. Traditionally, the measurement dispersion is described by a matrix of covariance. Formally, the matrix of precision is an inverse of the matrix of covariance. However, these two ways of description are not interchangeable. If an error distribution is described by the singular matrix of precision then the corresponding matrix of covariance does not exist, more precisely, it contains infinite values. It means in practice that some components of a measured vector are not measurable, in other words, an error of measurement can be arbitrarily large. The application of the matrix of precision makes possible an uniform description of measurements taken from various sources of information, even if measurements come from different devices and measure different components. Zero precision corresponds to components which are not measured.

In the third part, the problem of estimation of stationary parameters is formulated. Using the matrix of precision, the simple solution of the problem is presented. It appears that the best estimate is a weighted mean of measurements, where the weights are the matrices of the precision of measurements. It has been proved that the proposed solution is equivalent to the least squares method (LSM). Additionally it is simple and scalable.

In the fourth part of this paper the problem of the estimation of states of dynamic systems, such as a flying aircraft, is formulated. Traditionally, for such an estimation the Kalman filter is applied. In this case the uncertainty of measurement is described by the error matrix of covariance. If the matrix of precision is singular, it is impossible to determine the corresponding matrix of covariance and utilize the classical equation of Kalman filter. In the presented approach this situation is typical. It appears that there is such a transformation of Kalman filter equations, that the estimation based on the measurements with error described by the singular matrix of precision, can be performed. Such a transformation is presented and its correctness is proved.

In the fifth part, numerical examples are presented. They show the usability of the concept of matrix of precision.

In the sixth part, the summary and conclusions are shown, as well as the practical application of presented idea is discussed. The practical problems which are not considered in the paper are also pointed out.

## 2. The concept of precision matrix

Traditionally in order to describe the degree of the dispersion distribution the covariant matrix is used. There exist another statistics which can be used to characterize dispersion of the distribution. However, the covariance matrix is the most popular one and in principle the precision matrix is not used. Formally the precision matrix is the inverse of covariance matrix.

Wx=Cx1E1

The consideration may take much simpler form if the precision matrix is used. Note that precision matrix is frequently used indirectly, as inverse of covariance matrix. For example, in the well-known equation for the density of multi-dimensional Gauss distribution:

|C1|(2π)ke((xmx)TC1(xmx)2)E2

The equation (1) can not be used if the covariance matrix is singular. As long as the covariance (precision) matrix is not singular, the discussion which statistics is better to describe degree of the dispersion distribution is as meagre as discussion about superiority of Christmas above Easter. Our interest is in analysis of extreme cases (e.g. singular matrix).

At first, the singular covariance matrix will be considered. Its singularity means that some of the member variables (or their linear combinations) are measured with error equal to zero. Further measurement of this member variable makes no sense. The result can be either the same, or we shall obtain contradiction if the result would be different. The proper action in such a case is modifying the problem in such a manner that there is less degrees of freedom and the components of the vector are linearly independent. The missing components computation is based on the linear dependence of the variables. In practice, the presence of the singular covariance matrix means that the linear constraints are imposed on the components of the measured vectors and that the problem should be modified. The second possibility (infinitely accurate measurements) is impossible in the real world.

In distinction from the case of the singular covariance matrix, when the measurements are described by the singular precision matrix, measurements can be continued. The singularity of the precision matrix means that either the measurement does not provide any information of one of components (infinitive variation) or there exist linear combinations of member variables which are not measured. This can results from the wrong formulation of the problem. In such a case, the system of coordinates should be changed in such a manner that the variables which are not measured should be separated from these which are measured. The separation can be obtained by choosing the coordination system based on the eigenvectors of precision matrix. The variables corresponding to non-zero eigenvalues will then be observable.

There is also the other option. The singular precision matrix can be used to describe the precision of measurement in the system, in which the number of freedom degrees is bigger then the real number of components, which are measured. Then all measurements may be treated in a coherent way and the measurements from various devices may be taken into account. Thus all measurements from the devices which do not measure all state parameters can be included (i.e. direction finder). In this paper we are focusing on second option.

Each measuring device uses its own dedicated coordinate system. To be able to use the results of measurements performed by different devices, it is necessary to present all measured results in the common coordinate system. By changing coordinate system the measured values are changed as well. The change involves not only the digital values of measured results, but also the precision matrix describing the accuracy of particular measurement. We consider the simplest case namely the linear transformation of variables. Letydenote the vector of measurements in common coordinate system andxdenote the vector of measurements in the measuring device dedicated coordinate system. Letxandybe related as follows:

y=Ax+bE3

In this case the covariance of measurement changes according to formula:

Cy=ACxATE4

The precision matrix as inverse of covariance matrix changes according to formula:

Wy=Cy1=AT1WxA1E5

Consider the case when the transformationAis singular. In this case, we can act in two ways. If the precision matrixWxis not singular it can be inverted and the covariance matrixCxcan be find. Using the formula (4) and the obtained resultCyit is possible to invert back, to obtain the precision matrixWy. The second method consists in increasing transformationAin such way to be invertible. It is done by writing additional virtual lines to the transformation matrixA. The new transformation matrix is now as follows:

A'=[AAv]E6

Additional rows of this matrix should be chosen in such way that the obtained precision matrix has block-diagonal form:

Wy'=[WA00Wv]E7

it means that additional virtual lines of transformationA'should be chosen to fulfill the following relationship:

AvT1WxAv1=0E8

In such a way, the additional virtual lines do not have any influence on the computation result of precision matrix in the new coordinate system.

Consider the specific case. Let the measuring device measures target OX and OY positions independently, but with different precision. Measurement in the direction of the axis OX is done with accuracywOX=0.252and in the direction of axis OY measured precision iswOY=0.22. Then the precision matrix has a form:

Wx=[0.252000.22]E9

We are interested in accuracy of the new variable which is a linear combination of these variables. Lety=Axwhere:

A=[12]

MatrixAis not invertible. We add an additional row so that the matrixA'is invertible and formula (8) is fulfilled. General form of the matrix fulfilling this condition is of the form:

A'=[1250n16n]E10

We chosen=1. In that case:

A'1=1116[162501]E11

The precision matrix in the new coordinate system has the following form:

Wy=A'1TWxA'1=1116[1000.0025]E12

We ignore additional variables which have been added to makeA'invertible. Finally the accuracy of the measurement of variableyis 1/116.

The same result can be obtained using the first method. Then the covariance matrix is of the form:

Cx=[420052]E13

The value of the covariance of variableyaccording to formula (4) is:

Cy=[12][160025][12]=116E14

While the second method is more complicated it is nevertheless more general, and permits to find the precision matrix in the new coordinate system even if the precision matrix is singular.

In a case when it is necessary to make nonlinear transformation of variablesy=f(x), the linearization of transformation is proposed. Instead of matrixAthe Jacobian matrix of transformationfis used:

J=[fx]E15

In order to find the value of partial derivative, it is necessary to know pointx0around which linearization is done.

## 3. Estimation of stationary parameters

In engineering it is often necessary to estimate certain unknown value basing on several measurements. The simplest case is, when all measurements are independent and have the same accuracy. Then, the intuitive approach i.e. using the representation of results as arithmetic average of measurements is correct (it leads to minimal variation unbiased estimator). The problem is more complicated if the measured value is a vector and individual measurements have been performed with different accuracy. Usually, to characterize measurements accuracy the covariance matrix of measurement error distribution is used. Application of precision matrix leads to the formulas which are more general and simple. Further the precision matrix describes the precision of measurements when the number of degrees of freedom is smaller than the dimension of the space in which the measurement has been done. For example, direction finder measures the direction in the three dimensional space. The direction finder can be used as a radar with an unlimited error of measured distance. In this case, the covariance matrix of the measurement does not exist (includes infinite values). But there exists the precision matrix (singular). Information included in the precision matrix permits to build up optimal (minimal variation unbiased) linear estimator.

### 3.1. Formulation of the problem

Consider the following situation. The series of n measurementsxiof a vectorxvalue is done under the following assumptions:

1. There is no preliminary information concerning the value of the measured quantityx.

2. The measured quantity is constant.

3. All measurements are independent.

4. All measurements are unbiased (expected value of the measured error is zero).

5. All measurements can be presented in common coordinate system and the precision matrix Pi which characterizes the measurement error distribution in these coordinates, can be computed.

The problem is to find the optimal linear estimator of unknown quantityxand to find its accuracy. By optimal estimator, we understand the unbiased estimator having minimal covariance. By estimation of precision we understand presenting its covariance (or precision) matrix.

### 3.2. The solution

The first step consists in presenting all measurement results in the common coordinate system. The precision matrices must be recalculated to characterize the measurement error distribution in the common coordinate system. The method of the recalculation the precision (covariance) matrixes in the new coordinated system have been presented before. If all measurements have been done in the same coordinate system, the first step is omitted.

The unbiased minimal variation estimator of unknown quantityxis a weighed average of all measurementsxi, where the weights are the precision matricesWiof the individual measurements. The precision matrixWxof such estimator is equal to the sum of the precision matrixesWiof all measurements.

x^=WixiWiE16
Wx^=WiE17

In formula (16) the results of the individual measurements are represented as column vectors. Formulas (16-17) also can be presented in the iterative form (18-21) :

x1=x1E18
Wx^1=W1E19
x^i+1=Wx^ix^i+Wi+1xi+1Wx^i+Wi+1E20
Wx^i+1=Wx^i+Wi+1E21

Proof:

The presented formula represents the particular case of the general estimator of statexof the linear system, in which information aboutxis accessible viay=Ax+e, whereyis the vector of the measured results,Ais observation which is the projection of the system state on the measured vector,eis random noise having average value and covarianceEeeT=C, which represents the measurement errors. In such case, the best linear unbiased estimator has the following form:

x^=C1A(ATC1A)1yE22

In our case, the formula is radically simplified. All measurement results are presented in the same coordination system, therefore the observation Matrix has the following form:

A=[10...001...0............00...1.......10...001...0............00...1]E23

Since all measurements are independent, the covariance matrix has the block-diagonal form:

C=[C10...00C2...0............00...Cn]E24
C1=[C110...00C21...0............00...Cn1]=[W10...00W2...0............00...Wn]E25

After simplification and changing of the multiplication order (symmetrical matrix) we obtain:

x^=C1A(ATC1A)1y=Wi(Wj)1yi=Wiyi(Wj)1E26

As we can see, it is another form of formula (16). Its interpretation is easy to read and easy to remember. The optimal linear estimator represents the weighed average of all measurements, when weighs are the precision matrices of individual measurements.

## 4. Modified Kalman filter

In many cases it is necessary to estimate the changing state vector of the system. The value of the vector changes between successive measurements. Such situation exists in radiolocation when the position of moving target is tracked. Restricting ourselves to linear systems, the solution of this problem is known as the Kalman filter. In the Kalman filter theory, the model of system is presented as the pair of equations:

xi+1=Fxi+qi+1E27
zi+1=Hxi+1+ri+1E28

The first equation describes dynamics of system in the discrete time domain. Vectorqmodels the influence of internal noise. It is assumed that expected valueqis zero and it is independent from the vector of state valuex, as well as of the values of vectorqat the previous iterations:

Εqi=0E29
Εijqiqj=0E30
ΕqiqiT=QE31

The covariance of internal noiseqis described by matrixQ. The second equation describes outputzof the system which depends on actual state of the vectorx. The vectorrmodels the influence of noise on the measuring process. Further it is assumed that the expected valueris equal to zero and it is independent from the value of the state vectorx, internal noise vectorq, as well as of the vectorrfrom the previous iterations:

Εri=0E32
Εijrirj=0E33
ΕririT=RE34

It is assumed that we have estimate of the valuex^i, accuracy of which is described by covariance matrixPiand as well as the new measurementzi+1which is accurately described by the covariance matrixRi+1. How taking into consideration the last measurement can we obtain the estimated value of the state vector at the timei+1? The solution of this problem leads to the classic Kalman filter equation. Kalman filter can be presented in the iteration form:

new estimate =state prediction + correctioncorrection = gain*(new measurement – measurement prediction)

The equation of the state prediction has the following form:

x^i+1|i=Fx^iE35

The covariance matrix of the state prediction has the following form:

Pi+1|i=FPiFT+Qi+1E36

The equation of the measurement prediction has the form:

z^i+1|i=Hx^i+1|iE37

The Kalman gain is defined as:

Ki+1=Pi+1|iHT[HPi+1|iHT+Ri+1]1E38

The new estimate of the state has the following form:

x^i+1=x^i+1|i+Ki+1(zi+1z^i+1|i)E39

The covariance matrix of new estimate of the state has the following form:

Pi+1=[1Ki+1H]Pi+1|iE40

Equations (27-40) constitutes the description of the classic Kalman filter. The Kalman filter can be considered as the system in which the input consists of string of measurementszitogether with the covariance matrixRiwhich characterizes the accuracy of the i-th measurement and with the output being new estimate of the state vectorx^itogether with the covariance matrixPiwhich describes accuracy of this estimate. In the case when the precision of measurements is described by the singular precision matrixWi, it is impossible to obtain corresponding covariance matrixRiand the classic Kalman filter equation can not be used (covariance matrix is required). Such situation happens for instance when the movement of the object based on the bearings is tracked. The bearing can be treated as a degenerated plot in which precision of distance measurement is equal zero. Thus bearing is the plot described by the singular precision matrix. Determination of the covariance matrix is impossible. However, it is not necessary. The only equation in which the covariance matrixRis used is equation (38). The covariance matrix in this equation is inverted by indirect way. A part of the equation (38) in which matrixRexists has form:

[HPHT+R]1E41

It is easy to prove that:

A[R1+A1]R=[A+R]E42

We invert both sides:

R1[R1+A1]1A1=[A+R]1E43

Hence:

[HPHT+R]1=R1[R1+[HPHT]1]1[HPHT]1E44

It can be written as:

[HPHT+R]1=W[W+[HPHT]1]1[HPHT]1E45

Finally, the equation (38) has form:

Ki+1=Pi+1|iHTWi+1[Wi+1+[HPi+1|iHT]1]1[HPi+1|iHT]1E46

The only problem which can appear here is the possible singularity of the matrixHPi+1|iHT. This is the covariance matrix of the measurement prediction. If this matrix is singular, it means that we have certainty about measurement result of some parts and act of filtration have no sense as it has been discussed before. During normal filtration process such situation never happens. In such transformed form of Kalman filter the measurements which accuracy is described by the precision matrix can be used as the input, even if this matrix is singular. The price which is to pay is the necessity to twice invert the matrix which dimension corresponds to the dimension of the observation vector.

## 5. Examples

### 5.1. Estimation of the static system.

In order to demonstrate the proposed technique, the following example is used. The position of tracking target is determined using three measurements. The first measurement comes from the radar. The second one comes from the onboard GPS device. The third one comes from the direction finder. The radar is a device which measures three coordinates: slant range (R[m]), azimuth (β[rad]), and elevation angle (ϕ[rad]). For our simulation we assume that standard deviation of particular errors are:[15000.0010.001]([m rad rad]) i.e. the radar works as an altimeter precisely measuring elevation and azimuth while the slant range is not precisely measured. As far as GPS device is concerned we know that this device measures position with accuracy of up to 100 m and this measurement can be presented in any Cartesian coordinate system. The altitude is not measured by GPS. The standard deviation of bearing error for direction finder is [0.001] ([rad]). We know also very precisely the location of the direction finder. For this example the simulation has been done. We have chosen Cartesian coordinate system located at the radar as the global coordinate system. Furthermore, we have assumed that the tracking target is at the pointx=[300004000012000]. The radar position is then atR=[000]. Bearing finder is in the pointN=[70000100000]. We obtain following measurements results:

zGPS=[3002939885]E48
zNam=[-0,92733]E49

Basing on these results we want to obtain the estimator ofx. The first step is to present the results of measurements in the common coordinate system. In our case it isXYZcoordinate system connected to the radar. Now, some values should be attached to missing variables. If the transformation is linear, we can assign them any values. If the transformation of variables is nonlinear, we linearize around an unknown point. The values of the missing variables are estimated based on results of other measurements. After assigning the missing variables we obtain:

zGPS=[300293988511766]E51
zNam=[51363-0.927330.23113]E52

Transforming to new coordinate system, we obtain following results:

zGPSXYZ=[300293988511766]E54
zNamXYZ=[300013999711766]E55

In order to determine the precision matrix we invert the corresponding covariance matrices:

Wx=Cx1E56

The accuracy of the GPS device is 100 m. Therefore we consider 100 as the standard deviation of error distribution.

WGPS=CGPS1=[1002001002]1=[0.0001000.0001]E57

The standard deviation of the direction finder is 0.001 rad. The variance and precision are accordingly:

WNam=CNam1=[0.0012]1=106E58

After inserting zeros to the rows and columns corresponding to missing variables we obtain the following precision matrices:

WGPS=[0.00010000.00010000]E60
WNam=[00000000106]E61

When applying the linear transformation of variables:y=Tx+athe covariance matrix changes according to the formula:Cy=TCxTT. In the case of the nonlinear transformation:y=Y(x), we replace the matrixTby the Jacobian matrixJ, which is the linearization of this transformation.

J=[y1x1...y1xn.........ynx1...ynxn]x=xE62
Cy=JCxJT. Similarly we obtain:Wy=J1TWxJ1. In our case, the radar and the direction finder (after inserting the missing variables) operate in the spherical coordinates which are related to global system by the set of formulas:
X=X0+Rcos(φ)sin(β)E63
Y=Y0+Rcos(φ)cos(β)E64
Z=Z0+Rsin(φ)E65

The Jacobian matrix of such transformation has the following form:

J=[cos(φ)sin(β)Rcos(ϕ)cos(β)Rsin(φ)sin(β)cos(φ)cos(β)Rcos(φ)sin(β)Rsin(φ)cos(β)sin(φ)0Rcos(φ)]E66

Transforming variables from the local coordinate system of the measuring device to global system, we obtain as follows:

In case of the GPS device we do not have any change of variables. We are only adding the zero values corresponding to additional variable to the precision matrix:

WGPSXYZ=[0.00010000.00010000]E68

For the direction finder:

WNamXYZ=JzNam1TWNamJzNam1=[14.419.201<1e-1519.20125.604<1e-16<1e-15<e-16<1e-32]e5E69

Finally, we obtain the position estimator:

resulting in:

x*=[300083997311908]E71

Note that utilization of the measurements from GPS device and direction finder, which do not measure the height, actually results in some improvement of altitude estimation. This is due to the fact that the variables which provide the radar measurements in XYZ coordinates are not independent, but they are strongly correlated. The linear combination of them is measured with high accuracy. Thus, by improving the estimation of XY variables we also improve the estimation of the variable in Z direction.

### 5.2. Estimation in the dynamic system

The next example presents the application of the proposed technique to the estimation of the parameters of a dynamic system. It is the most typical situation when the racking target is moving. Our purpose is the actualization of motion parameters of tracking target based on three measurements. We assume that the tracking is two dimensional. The following parameters are tracked:x- the position on axis OX;vx- the motion speed on axis OX;y- the position on axis OY;vy- the motion speed on axis OY. We consider the flight altitudezas fixed and equal 2000. Finally, we have the following data:

At time:

T0=100E72

Based on previous measurements, we obtain estimation of the initial parameters of tracked target motion:

x0=[xvxyvy]=[259.5126.760075114.3]E73

The covariance matrix of this estimation has the form:

Cx0=[60020000202000060020000202]E74

At time:

T1=108E75

The tracked target has been detected by the radar R1 which is located at the beginning of our coordinate system

R1=[000]E76

The parameters of the detection are:

zR1=[590250.11690.2122]E77

We assume that the radar measurement is unbiased. The covariance matrix of the measurement error has the following form:

CR1=[5520000.0820000.152]E78

The next position measurements of the tracking target took place at the time:

T2=113.8E79

We obtain the bearing of tracked target. The direction finder was located at the point:

N2=[1000040000100]E80

The bearings value is:

zN2=[0.3853]E81

The covariance measurement error is:

CN2=[0.052]E82

At the near time:

T3=114E83

We obtain bearing from another direction finder which was located an point:

N3=[3000050000120]E84

The bearing value is:

zN3=[1.2433]E85

The covariance measurement error is:

CN3=[0.052]E86

Traditionally, to solve such a problem, the theory of Kalman filter is used. In this theory two assumptions are usually accepted. First that all measurements are carried out by the same device. Second, that the measurements are done in regular time intervals. None of the above assumptions is satisfied in our example. To address the issue of different measuring device, we assume that the measurements are always presented in the common global coordinate system, and their dispersion is described by the precision matrix which can be singular. Using the modified formulas of Kalman filters (46), the estimation can be done, even if the precision matrix is singular. In order to address the issue of the irregular time intervals of the measurements, the Kalman filter has been modified to consider the changes of time interval between individual measurements. It means that the matrixFdescribing dynamics of the tracked process and matrixQdescribed covariance of the internal noise of tracked process depend on timeΔtwhich elapses from the last measurement. We assume the linear model of the tracked target movement in which velocity does not have systematic changes. Therefore the equation of motion has the following form:

{x(t)=x0+vx0*tvx(t)=vx0y(t)=y0+vy0*tvy(t)=vy0E87

We introduce the following state vector of Kalman filter:

x=[xvxyvy]E88

Therefore, the dynamic matrixF(Δt)has the following form:

F(Δt)=[1Δt000100001Δt0001]E89

We also assume that the internal noise of the process has additive character and it is the source of change of motion velocity. In such a case, the velocity variation is increasing linearly with time:

Qv=Q[Δt00Δt]E90

The internal noise related to velocity affects the position through the dynamic process described by matrixF(Δt). It can be proved that in this case the covariance matrixQ(Δt)of the process internal noise has the following form:

Q(Δt)=Q[Δt33Δt2200Δt22Δt0000Δt33Δt2200Δt22Δt]E91

The parameterQprovides the information on how much the velocity of the motion changes during one second in the medium square sense. In the simulations we assume thatQ=1.

Additionally we assume that the observation vector has the following form:

z=[xy]E92

Therefore, the observation matrixHhas a form:

H=[10000010]E93

The direction finder, as well as the radar, make measurements at spherical coordinate system. To present measurements results at the global reference system we use formulas (63-65) described in the first example. The necessary elements have been already discussed. The algorithm of the estimation of the motion parameters can be described on the basis of measurements coming from different sources. Utilizing previous measurements we know the estimationx^0of the tracked target motion parameters in timet0and the covariance matrixp0, describing the precision of this estimate. When at the timet1>t0the next measurement occur, the following steps are taken:

• Calculate the matricesF(Δt)andQ(Δt)according to formulas (89, 91)

• Calculate the prediction of the state vectorx^t1|t0using formula (35)

• Calculate the covariance matrixPt1|toof the prediction of the state using formula (36)

• Calculate the prediction of detectionzt1|t0XYZat the global coordinate system

• Calculate the prediction of detectionzt1|t0Radat the local radar (direction finder) coordinate system

• Expand the measurements vectorz˜t1Rad. The values which has not been measured are replaced by predicted values from the previous measurements.

• Create the precision matrixWt1Radof the measurements at the local radar (direction finder) coordinate system. The values which have not been measured have zero precision.

• Transform the expanded vector of measurementsz˜t1Radand corresponding precision matrixWt1Radto global coordinate systemz˜t1XYXandWt1XYZ.

• Using formula (39-40, 46) calculate the new estimate of the motion parametersx^t1and their corresponding precision matrixPt1.

Note that tracking is done in two dimensional space. The altitude Z is not tracked and is fixed as Z=2000. If the altitude is required in computation like for example in formula (97) we take Z=2000m.

For the first measurements we have accordingly:

Δt=108100=8E94
x^108|100=F(8)x^100[75412759161114]E95

The covariance matrix of the prediction:

P108|100=F(8)TP100F(8)+Q(8)E96

The prediction of the detection at the global coordinate system XYZ:

z108|100XYZ=[754591612000]E97

In the last formula we use information on tracking target altitude 2000m. Now, we consider the system of the radar R1. The prediction of the detection at the radar local coordinate system:

The radar measures all coordinates. It is not necessary to increase measuring vector and to use the prediction.

The dispersion of the radar measurements is described by the precision matrix of the form:

After transformation to the global coordinate system XYZ we obtain:

z˜108XYZ=[6732.7573062000]E101

The precision matrix is transformed according to formula:

whereJz^is Jacobian matrix of transformation (66) calculated at the pointz^108Rad.

Because we are tracking only the components XY, we ignore the last row in the measurement vectorz˜108XYZ, as well as the last row and the last column in the precision matrixW108XYZ.

Now, we can determine Kalman gainKand the state estimatex^108, as well as the corresponding covariance matrixP108:

K108=P108|100HTW108[W108+[HP108|100HT]1]1[HP108|100HT]1E103
x^108=x^108|100+K108(z˜108XYZz^108|100)E103.1
P108=[1K108H]P108|100E105

It is the end of the first step of the determination of the estimate of tracking target motion parameters.

The next step is more interesting because it demonstrates how one can use the measurements which were done by the direction finder. Accordingly:

For the first measurement we have:

Δt=113.8108=5.8E106
x^113.8|108=F(5.8)x^108E107

The covariance matrix of prediction is:

P113.8|108=F(5.8)TP108F(5.8)+Q(5.8)E108

The prediction of the detection at the global coordinate system XYZ

z113.8|108XYZ=[1571.7566472000]E109

We are taking into consideration the direction finder N2. The prediction of the detection at the direction finder local coordinate system:

z113.8|108N2=[187750.46870.1015]E110

The direction finder measures only azimuthzN2=[0.3853]. We treat the direction finder as a radar which measures all coordinates. The missing coordinates are obtained utilizing the predictionz113.8|108N2. We obtain:

z˜113.8N2=[187750.38530.1015]E111

The precision matrix variables calculated using the prediction have zero precision:

W113.8N2=[00001/0.0520000]E112

After the transformation to global XYZ coordinate system we obtain:

z˜113.8XYZ=[2987.1572912000]E113

As before, we determine the precision matrixW113.8XYZat the global XYZ coordinate system and the Kalman gainK113.8as well as new estimatex^113.8together with the corresponding covariance matrixP113.8:

W113.8XYZ=Jz^1TW113.8N2Jz^1E114
K113.8=P113.8|108HTW113.8[W113.8+[HP1138|108HT]1]1[HP113.8|108HT]1E115
x^113.8=x^113.8|108+K113.8(z˜113.8XYZz^113.8|108)E116
P113.8=[1K113.8H]P113.8|108E117

It is obvious that in the case of the second bearing we act similarly:

Δt=114113.8=0.2E118
x^114|113.8=F(0.2)x^108E119

The covariance matrix of prediction:

P114|113.8=F(0.2)TP113.8F(0.2)+Q(0.2)E120

The prediction of the detection in global XYZ coordinate system:

z114|113.8XYZ=[2087566252000]E121

Now, we consider the local coordinate system of the direction finder N3. The prediction of the detection at the direction finder local coordinate system:

z114|113.8N3=[287501.3380.065]E122

The direction finder measures only azimuthzN3=[1.2433].

z˜114N3=[287501.24330.065]E123

The precision matrix variables defined using the prediction have zero precision:

W114N3=[00001/0.0520000]E124

After transformation to global XYZ coordinate system we obtain:

z˜114XYZ=[2560.1593322000]E125

As before, we determine the precision matrixW114XYZat the global XYZ coordinate system and the Kalman gainK114as well as a new estimatex^114together with the corresponding covariance matrixP114:

W114XYZ=Jz^1TW114N3Jz^1E126
K114=P114|113.8HTW114[W114+[HP114|113.8HT]1]1[HP114|113.8HT]1E127
x^114=x^114|113.8+K114(z˜114XYZz^114|113.8)E128
P114=[1K114H]P114|113.8E129

The presented example demonstrates the power of the described technique. Even a single bearing can improve the estimation of motion parameters of the tracking target. If several bearings are utilized, they need not to be simultaneous.

## 6. Summary

In the proposed technique the measurements carried out by different devices are treated in a simple and uniform manner. The key idea comprises in expansion the vector of the measured values and insertion of missing variables based on the prediction. The precision matrix is used to describe their dispersion. In order to obtain the estimate of the tracked target state we have to present all measurements and corresponding precision matrixes in a common coordinate system. The formulas (16-17, 18-21) should be used for static systems or the modified Kalman filters equations (27-40, 46) should be used for dynamic systems.

For linear objects, the Kalman filters are the optimal estimators. In the presented example dynamics of the tracked target has been described by linear differential equation The presented methodology can be applied also in the case when the dynamics of tracked target is nonlinear. In this case, instead of formula (27) we use linearization. Let the dynamics of the tracked process be described by a nonlinear function:

x(t+Δt)=F(x(t),Δt)E130

In order to determine the covariance of the state prognosis we use linearizationF˜(x(t),Δt)of the functionF(x(t),Δt)

P(t+Δt)=F˜(x(t),Δt)P(t)F˜(x(t),Δt)T+Q(Δt)E131

where:

F˜(t,Δt)=[fixj]E132

In order to increase accuracy, we can decrease time interval. Calculations (131) could be done several times. Let:

δt=ΔtnE133
x(t+δt)=F(x(t),δt)E134
x(t+Δt)=F(F(F(F(...F(x(t)),δt...),δt),δt),δt)E135

Analogically:

P(t+δt)=F˜(x(t),δt)P(t)F˜(x(t),δt)T+Q(δt)E136
P(t+Δt)=F˜(x,δt)P(F˜(x,δt)P(...F˜(x,δt)P(x)F˜(x,δt)T+Q(δt)...)F˜(x,δt)T+Q(δt))F˜(x,δt)T+Q(δt)E137

In the past, this approach was rejected due to computer high power requirements. Presently it creates no problem at all.

An interesting case of proposed methodology application is the use of measurements from Doppler radar. The Doppler radar measures frequency shifting of received signal permitting to detect approaching speed of tracking targets. More precisely, it permits to determine speed radial componentvRof the tracking target. The methodology is analogical to the example presented before. The velocity vector is expanded in order to include all components:

v˜=[vRvβvϕ]E138

The missing values are calculated utilizing the prediction. The corresponding precision matrix has the following form:

W=[δvR00000000]E139

After transformation to the global coordinate system XYZ we can use measurements from the Doppler radar to improve estimation of the tracking target motion parameters.

In all so-far considered examples, we assumed that time error does not exist. In practice, the time is always measured with certain error. If for example the measuring time is presented in seconds, then during one second the tracked target can move several hundreds meters. Fortunately, in our case the error of time measuring can be easily taken into consideration. Time errorδtis transformed into the position measurements errorδxaccording to formula:

δx=vx*δtE140

Assuming that the time measuring error is independent from the position measurement error, the variances of both errors are added:

Cx2'=Cx2+δx2=Cx2+vx2δt2E141

The error of the time measurement can be easily taken into consideration by the proper increase of the error covariance valueCx2of the measurement component X. Of course, the same apply to the remaining components Y and Z.

When tracking the state of dynamic system by means of the modified Kalman filter the assumption that the measurements are done in regular time intervals has been abandoned. Nevertheless, it has been assumed that the received measurements are sequential:t1t2t3....tn1tn. Sometimes even this assumption is unfulfilled. It may happen that due to a transition delay the measurements carried out at earlier time are received later then the ones obtained in later time. In order to consider the measurements delay the very simple but useful trick can be used. We store in memory the series of last measurements together with their estimated parameters values and the corresponding covariance matrices which describe accuracy of estimate. When the delayed measurement reaches the system we retrieve from the memory an estimation of timet0which occurred earlier then the timetd(attributed to the delayed measurement). All measurements later thent0and delayed measurements are rearranged to be sequential in time. Then, the prediction and estimation procedures are performed consecutively for each measurement. This way, the delayed measurement is taken into consideration. It must be noted that storing only the values of estimated parameters is not enough. In order to make the correct estimation, it is necessary to know also the covariance matrix of these parameter estimates.

The presented method is in 100% correspondence with the well-known least squares method (LSM). The careful analysis of the presented examples with taking into consideration the different weights of particular errors, existing correlations between them as well as the flow of time will provide the same results for the estimated values as the LSM method. Therefore the proposed methodology do note give better estimators then the classical theory. However the presented methodology avoids the very complicated and arduous computations and presents all measurements in a uniform way. Such approach is very useful for the automatic data processing by an automatic tracking system.

Since the presented technique is in 100% correspondence with the LSM, it also it discloses the weak points of LSM. In particular, it is not robust methodology. It is not robust for the values drastically odd (different) and for large errors. Even the single erroneous measurement not fitting the assumed model of errors distribution results in the drastic increase of the final error of the estimator. Because of this, it is recommended that the preliminary preselection of tracking measurements should be done. Drastically different values should be rejected.

The Kalman filter represents an optimal estimator for linear system only if the real model of the process corresponds to the one accepted during Kalman filter (27-34) design. It is particularly important when considering the error values. Consider for example the ladar (laser radar) which measures the position of an object from the distance of a few tens of kilometers with accuracy up to 5 m. Naturally, the errorδR=5should be taken into consideration. However, usually other sources of errors exist. For example, the position of ladar is known only with the limited precision, the time of measurement is provided with a limited accuracy. The Earth curvature can also be a source of errors during calculations. Based on the author’s experience some various processes which normally are not taken into consideration may be the source of casual and systematic errors. For this reason, asserting the error valueδR=5is a wrong idea. According to author it is better to use larger values of errors then the small ones. If erroneous values are assumed in the filter design and are larger then in reality the resulting filter is not optimal, but it is more flexible and robust with respect to drastically different values. For this reason, moderation and caution should be used in choosing the parameters of the model utilized to design a filter.

## How to cite and reference

### Cite this chapter Copy to clipboard

Jacek Karwatka (January 1st 2010). Tracking of Flying Objects on the Basis of Multiple Information Sources, Radar Technology, Guy Kouemou, IntechOpen, DOI: 10.5772/7181. Available from:

### Related Content

#### This Book

Edited by Guy Kouemou

Next chapter

By Guy Kouemou

First chapter

#### Optimum Mechanical Design of Binary Actuators Based on Shape Memory Alloys

By A. Spaggiari, G. Scirè Mammano and E. Dragoni

We are IntechOpen, the world's leading publisher of Open Access books. Built by scientists, for scientists. Our readership spans scientists, professors, researchers, librarians, and students, as well as business professionals. We share our knowledge and peer-reveiwed research papers with libraries, scientific and engineering societies, and also work with corporate R&D departments and government entities.

View all books