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

_ _<br />

Φ<br />

MAA<br />

MAA<br />

MAA<br />

Φ<br />

: =<br />

QQ<br />

Φ<br />

QW<br />

⎡<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎢<br />

⎣<br />

: =<br />

MAA<br />

0<br />

0<br />

Φ<br />

3x<br />

4<br />

3x<br />

4<br />

1<br />

2<br />

QQ<br />

5-11<br />

,<br />

,<br />

,<br />

⎡<br />

1<br />

⎢<br />

⋅ ⎢ L<br />

⎢ B<br />

⎢<br />

ωA,<br />

⎣<br />

B<br />

MAA<br />

M<br />

M<br />

M<br />

0<br />

I<br />

Φ<br />

3<br />

3x3<br />

I<br />

−<br />

3<br />

QW<br />

,<br />

,<br />

,<br />

0<br />

3x3<br />

∆ ⋅ I<br />

I<br />

3<br />

3<br />

( )<br />

⎥ [ ] ⎥ ⎥⎥<br />

B T<br />

ω<br />

⎤<br />

A,<br />

B<br />

L<br />

B<br />

− ω ×<br />

A,<br />

B<br />

( )<br />

⎥<br />

( ) [ ] ⎥ ⎥⎥<br />

B T<br />

− q<br />

⎤<br />

A<br />

L L L<br />

B<br />

0 ⋅ I − q ×<br />

: =<br />

⎡<br />

1 ⎢<br />

⋅ ⎢<br />

2 ⎢ B<br />

⎢<br />

qA<br />

⎣<br />

3<br />

L<br />

A<br />

⎦<br />

⎤<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎥<br />

⎦<br />

Equation 5.6-5<br />

⎦<br />

Equation 5.6-6<br />

Equation 5.6-7<br />

This non co-ordinated model ignores missile velocity vector rotation<br />

coupling the missile linear and rotational states. Process noise is therefore<br />

needed to cope with the un-modelled dynamics with state error growth<br />

constrained using high frequency IMU data.<br />

Γ<br />

=<br />

( ) T<br />

2<br />

0. 5 ⋅ ∆ ∆ 1<br />

( Q , Q )<br />

2<br />

T<br />

2<br />

T<br />

( Γ ⋅ diag ( 50 ⋅1<br />

) ⋅ Γ , Γ ⋅ diag ( 200 ⋅1<br />

) ⋅ Γ )<br />

Q<br />

MAA<br />

: =<br />

⎛<br />

⎜<br />

⎜<br />

⎜<br />

⎜<br />

⎜<br />

⎜<br />

⎝<br />

3<br />

MAA<br />

TLL<br />

Q<br />

L<br />

−<br />

L<br />

−<br />

QQ<br />

M<br />

M<br />

M<br />

M<br />

M<br />

MLL<br />

MAA<br />

GS<br />

σ<br />

Q<br />

L<br />

2<br />

RN<br />

L<br />

−<br />

: =<br />

QW<br />

⋅ I<br />

3<br />

M<br />

M<br />

M<br />

M<br />

M<br />

0<br />

0<br />

0<br />

3<br />

3<br />

3<br />

3<br />

x3<br />

L<br />

x3<br />

L<br />

x3<br />

Equation 5.6-8<br />

Equation 5.6-9<br />

⎞<br />

⎟<br />

⎟<br />

⎟<br />

⎟<br />

⎟<br />

⎟<br />

⎠<br />

Equation 5.6-10

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

Saved successfully!

Ooh no, something went wrong!