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

Create successful ePaper yourself

Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.

Chapter 4 / Target Tracking<br />

_ _<br />

Expanding and expressing in terms of cosine and sine series,<br />

⎛<br />

⎜ 1<br />

⎜<br />

⎜<br />

⎜ 0<br />

⎜<br />

⎜<br />

⎝ 0<br />

,<br />

,<br />

,<br />

sin<br />

− ω<br />

iA<br />

iA<br />

iA<br />

iA<br />

( ω ⋅ ∆t<br />

) ω , ( 1 − sin ( ω ⋅ ∆t<br />

) ) ( ω )<br />

cos<br />

iA<br />

A,<br />

TV<br />

A,<br />

TV<br />

iA<br />

iA<br />

( ω ⋅ ∆t<br />

) ,<br />

sin ( ω ⋅ ∆t<br />

)<br />

⋅ sin<br />

A,<br />

TV<br />

( ) ( ) ⎟ ⎟⎟⎟⎟⎟⎟<br />

iA<br />

iA<br />

ω ⋅ ∆t<br />

,<br />

cos ω ⋅ ∆t<br />

A,<br />

TV<br />

A,<br />

TV<br />

4-20<br />

W<br />

Φ<br />

i<br />

: =<br />

A,<br />

TV<br />

A,<br />

TV<br />

A,<br />

TV<br />

A,<br />

TV<br />

Equation 4.5-24<br />

These dynamics were used by Vorley [V.3] to derive the weave tuned filters<br />

presented in §21.5, and by Nabbaa [N.4] when comparing constant and<br />

variable speed co-ordinated turning models. The state observer provides an<br />

estimation of the weave frequency,<br />

ω<br />

A<br />

A,<br />

TV<br />

: =<br />

P&<br />

× &P<br />

&<br />

A<br />

t<br />

A<br />

t<br />

P&<br />

2<br />

o,<br />

t<br />

0.<br />

16<br />

Equation 4.5-25<br />

For the IMM a lower limit of 0.025 Hz is placed on the weave frequency<br />

estimate, first to avoid numerical problems, and also to prevent asymptotic<br />

reduction to an acceleration filter. The weave frequency accuracy<br />

requirements for CLOS guidance are explored in §6.<br />

4.6 IMM Filter Measurement Updates<br />

Target range, range rate and angle measurements from a phased array radar<br />

stimulate each filter in the IMM,<br />

RD<br />

Z ~<br />

T<br />

( ) T<br />

~ ~<br />

XT XT ~ T ~ T<br />

Pt<br />

, Pt<br />

, ΨA<br />

, ΘA<br />

: = &<br />

2<br />

Equation 4.6-1<br />

The estimated target measurements are (kinematic type is clear in context),<br />

⎛<br />

⎜<br />

⎜<br />

⎝<br />

P<br />

A<br />

t<br />

•<br />

P<br />

A<br />

t<br />

,<br />

A<br />

Pt<br />

• P&<br />

P<br />

o,<br />

t<br />

A<br />

t<br />

,<br />

RD<br />

Z<br />

T<br />

tan<br />

−1<br />

: =<br />

⎛<br />

⎜<br />

⎝<br />

P<br />

P<br />

YA<br />

t<br />

XA<br />

t<br />

⎞<br />

⎟<br />

⎠<br />

,<br />

− tan<br />

−1<br />

⎛<br />

⎜<br />

⎝<br />

P<br />

P<br />

ZA<br />

t<br />

hA<br />

t<br />

⎞ ⎞<br />

⎟ ⎟<br />

⎟<br />

⎠<br />

⎟<br />

⎠<br />

T<br />

Equation 4.6-2<br />

The linearised measurement matrix with respect to the IMM states at the<br />

measurement reference time,<br />

⎞<br />

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

Saved successfully!

Ooh no, something went wrong!