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 />

⎢<br />

⎣<br />

0<br />

3x2<br />

,<br />

∂ g<br />

∂ P<br />

ZG<br />

d<br />

ZA<br />

m<br />

⋅<br />

AC<br />

B<br />

B<br />

B T<br />

B ⎤<br />

( TA<br />

( 3 ) , TA<br />

( 6 ) , TA<br />

( 9 ) ) M 03x3<br />

M TA<br />

⎥<br />

⎦<br />

5-15<br />

H<br />

ML<br />

: =<br />

Equation 5.8-11<br />

Apportioning the acceleration innovations to the missile angular dynamics,<br />

⎡ ∂ T<br />

⎢<br />

⎢ ∂ Q<br />

⎣<br />

B<br />

A<br />

B<br />

A<br />

⋅<br />

⎛<br />

⎜<br />

⎝<br />

&P<br />

&<br />

A<br />

m<br />

−<br />

AC<br />

H<br />

MA<br />

ZG<br />

( 0 , 0 , g )<br />

d<br />

: =<br />

T<br />

⎞<br />

⎟<br />

⎠<br />

M<br />

∂ ϕ<br />

∂ ω<br />

B<br />

ARM<br />

B<br />

A,<br />

B<br />

M<br />

∂ ϕ<br />

∂ ω&<br />

B<br />

ARM<br />

B<br />

A,<br />

B<br />

⎤<br />

⎥<br />

⎥<br />

⎦<br />

Equation 5.8-12<br />

The gravitational acceleration and its variation with height are given in<br />

§20.2 and §20.3 respectively. When accumulating data the measurement<br />

noise can be reduced by √n, where n is the number of measurements<br />

averaged. For noise of 500 µg/√Hz the measurement covariance is,<br />

AC<br />

( 4 ⋅ 2 1 )<br />

R : = diag ⋅<br />

5.8.3 Ground Radar Missile Measurement Update<br />

3<br />

Equation 5.8-13<br />

The missile range, range rate and angle measurements stimulate the missile<br />

linear dynamic partition. The estimated seeker measurements being,<br />

⎛<br />

⎜<br />

⎜<br />

⎝<br />

P<br />

A<br />

m<br />

•<br />

P<br />

UL<br />

A<br />

m<br />

Z ~<br />

M<br />

,<br />

( ) T<br />

XM XM ~ M ~ M<br />

m P m , A , A<br />

~ ~<br />

P , Ψ Θ<br />

: = &<br />

A<br />

Pm<br />

• P&<br />

P<br />

o,<br />

m<br />

A<br />

m<br />

,<br />

UL<br />

The linearised measurement matrix,<br />

Z<br />

M<br />

tan<br />

−1<br />

: =<br />

⎛<br />

⎜<br />

⎝<br />

P<br />

P<br />

YA<br />

m<br />

XA<br />

m<br />

⎞<br />

⎟<br />

⎠<br />

,<br />

− tan<br />

Equation 5.8-14<br />

−1<br />

⎛<br />

⎜<br />

⎝<br />

P<br />

P<br />

ZA<br />

m<br />

hA<br />

m<br />

⎞ ⎞<br />

⎟ ⎟<br />

⎟<br />

⎠<br />

⎟<br />

⎠<br />

T<br />

Equation 5.8-15

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

Saved successfully!

Ooh no, something went wrong!