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 5 / Missile State Observer<br />

_ _<br />

SO<br />

C<br />

: =<br />

⎡<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎣<br />

SO<br />

SO<br />

C<br />

L<br />

C<br />

L<br />

0<br />

TLL<br />

MTL<br />

5-9<br />

M<br />

M<br />

M<br />

M<br />

M<br />

SO<br />

SO<br />

SO<br />

C<br />

L<br />

C<br />

L<br />

C<br />

TML<br />

MLL<br />

MAL<br />

M<br />

M<br />

M<br />

M<br />

M<br />

SO<br />

SO<br />

0<br />

L<br />

C<br />

L<br />

C<br />

MLA<br />

MAA<br />

⎤<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎦<br />

Equation 5.4-1<br />

Partitioning to 3 and 4-vector level in the case of the target linear partition<br />

(and likewise for the missile linear and rotational partitions),<br />

SO<br />

5.5 Initialisation<br />

⎛<br />

⎜<br />

⎝<br />

ϕ<br />

Q<br />

DC<br />

C<br />

TLL<br />

: =<br />

⎡<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎣<br />

TLL<br />

TLL<br />

TLL<br />

C<br />

L<br />

C<br />

L<br />

C<br />

PP<br />

VP<br />

AA<br />

M<br />

M<br />

M<br />

M<br />

M<br />

TLL<br />

TLL<br />

TLL<br />

C<br />

L<br />

C<br />

L<br />

C<br />

PV<br />

VV<br />

AV<br />

M<br />

M<br />

M<br />

M<br />

M<br />

TLL<br />

TLL<br />

TLL<br />

C<br />

L<br />

C<br />

L<br />

+ T T<br />

( X ) , 0 , ( X )<br />

T<br />

T<br />

SO X : =<br />

⎛<br />

⎞<br />

⎜ UL<br />

9 SO MA ⎟<br />

⎝<br />

⎠<br />

DC A<br />

W DC A A E A<br />

( ϕ ( P ) ) M ϕ ϕ ( P , P&<br />

) , ϕ ( P )<br />

X<br />

UL<br />

t<br />

SO<br />

X<br />

MA<br />

: =<br />

C<br />

PA<br />

VA<br />

AA<br />

⎤<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎦<br />

( DE ( X UL t UL t X UL t ) )<br />

Equation 5.4-2<br />

Equation 5.5-1<br />

T<br />

M<br />

0<br />

T<br />

3<br />

⎞<br />

⎟<br />

⎠<br />

T<br />

Equation 5.5-2<br />

The orientation and angular rate of the missile with respect to the Alignment<br />

frame is determined using utility functions and up-linked IMM target data.<br />

The launcher rotates slowly whilst tracking long-range targets hence the<br />

missile velocity, and its linear and angular accelerations are set to zero. The<br />

initial missile covariances must never be underestimated, and if necessary<br />

inflated to cope with all possible eventualities. If, as here, IMM data is used<br />

to initialise the missile state, the uncertainty in that state must include the<br />

pointing error of the launcher and the initial position error of the IMM<br />

initialisation source. After re-scaling and expanding the up-linked target<br />

state expectations the symmetric state covariance matrix,<br />

SO CTLL UL<br />

: = C<br />

+<br />

Equation 5.5-3

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

Saved successfully!

Ooh no, something went wrong!