14.02.2013 Views

Thesis - Leigh Moody.pdf - Bad Request - Cranfield University

Thesis - Leigh Moody.pdf - Bad Request - Cranfield University

Thesis - Leigh Moody.pdf - Bad Request - Cranfield University

SHOW MORE
SHOW LESS

You also want an ePaper? Increase the reach of your titles

YUMPU automatically turns print PDFs into web optimized ePapers that Google loves.

Chapter 4 / Target Tracking<br />

_ _<br />

A<br />

( Φ , Q )<br />

V<br />

V<br />

: =<br />

⎛<br />

⎜ ⎡ 1 , ∆t<br />

⎤<br />

⎜ ⎢ ⎥<br />

⎜ ⎢ ⎥<br />

⎜ ⎢ ⎥<br />

⎝ ⎣ 0 , 1 ⎦<br />

(Vqt) represents the noise power spectral density in (m 2 /s 4 /Hz),<br />

4.5.2 Constant Acceleration Filter<br />

4-16<br />

,<br />

V<br />

q<br />

t<br />

⋅<br />

⎡<br />

⎢<br />

⎢<br />

⎢<br />

⎣<br />

∆t<br />

∆t<br />

3<br />

2<br />

3<br />

2<br />

,<br />

,<br />

∆t<br />

2<br />

∆t<br />

2<br />

⎤<br />

⎥<br />

⎥<br />

⎥<br />

⎦<br />

⎞<br />

⎟<br />

⎟<br />

⎟<br />

⎠<br />

Equation 4.5-2<br />

Target longitudinal acceleration is generally small compared with lateral<br />

manoeuvring accelerations and target motion is best described by a constant<br />

“g” turn - the circular dynamic model, Nabaa [N.4] . The acceleration is<br />

directed along Target Velocity axes rather than Alignment axes, the state<br />

transition and noise covariance matrices being,<br />

⎡<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎣<br />

∆t<br />

8<br />

5<br />

∆t<br />

⋅ T<br />

20<br />

4<br />

⋅ T<br />

∆t<br />

6<br />

3<br />

A<br />

TV<br />

A<br />

TV<br />

⋅<br />

⋅<br />

⋅ T<br />

A<br />

A<br />

L<br />

A<br />

L<br />

A<br />

TV<br />

Φ<br />

q<br />

q<br />

⋅<br />

TV<br />

TV<br />

A<br />

: =<br />

q<br />

⋅ T<br />

⋅ T<br />

TV<br />

⎡<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎣<br />

TV<br />

A<br />

TV<br />

A<br />

0<br />

0<br />

I<br />

3<br />

L<br />

3x3<br />

L<br />

3x3<br />

M<br />

M<br />

M<br />

M<br />

M<br />

M<br />

M<br />

M<br />

M<br />

M<br />

∆t<br />

8<br />

∆t<br />

3<br />

4<br />

3<br />

∆t<br />

⋅ I<br />

A<br />

0<br />

∆t<br />

2<br />

L<br />

I<br />

3<br />

L<br />

⋅ T<br />

⋅ T<br />

2<br />

3<br />

3x3<br />

Q<br />

A<br />

A<br />

TV<br />

A<br />

TV<br />

⋅<br />

⋅<br />

⋅ T<br />

M<br />

M<br />

M<br />

M<br />

M<br />

: =<br />

A<br />

L<br />

A<br />

L<br />

A<br />

TV<br />

q<br />

q<br />

⋅<br />

A<br />

2<br />

TV<br />

TV<br />

−1<br />

q<br />

⋅ ∆t<br />

⋅ I<br />

∆t<br />

⋅ I<br />

⋅ T<br />

⋅ T<br />

TV<br />

TV<br />

A<br />

TV<br />

A<br />

L<br />

3<br />

L<br />

I<br />

⋅ T<br />

3<br />

3<br />

M<br />

M<br />

M<br />

M<br />

M<br />

⋅ T<br />

A<br />

TV<br />

A<br />

TV<br />

∆t<br />

6<br />

∆t<br />

2<br />

3<br />

2<br />

⎤<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎦<br />

∆t<br />

⋅ T<br />

Equation 4.5-3<br />

⋅ T<br />

⋅ T<br />

A<br />

TV<br />

L<br />

A<br />

TV<br />

L<br />

A<br />

TV<br />

⋅<br />

⋅<br />

⋅<br />

A<br />

A<br />

A<br />

q<br />

q<br />

q<br />

TV<br />

TV<br />

TV<br />

⎤<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎦<br />

Equation 4.5-4<br />

This noise matrix is diagonal and the elements of the PSD vector are<br />

selected dependent upon the expected manoeuvring capability of the target,<br />

TV<br />

TV<br />

[ q ] : = diag ( q )<br />

A<br />

A<br />

Equation 4.5-5<br />

Not only are the propagation equations more complex using directional<br />

acceleration states they must be transformed into the Alignment frame<br />

before IMM assimilation. As the IMM measurement updates are frequent

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!