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 3 / Inertial Navigation<br />

_ _<br />

ω<br />

G<br />

C,<br />

G<br />

: =<br />

⎛<br />

⎜<br />

⎜<br />

⎜<br />

⎜<br />

⎜<br />

⎜<br />

⎝<br />

ω<br />

ω<br />

ZE<br />

C,<br />

E<br />

ZE<br />

C,<br />

E<br />

0<br />

⋅ cos λ<br />

⋅ sin λ<br />

3.3-4<br />

d<br />

d<br />

⎞<br />

⎟<br />

⎟<br />

⎟<br />

⎟<br />

⎟<br />

⎟<br />

⎠<br />

⎛<br />

⎜<br />

⎜<br />

⎜<br />

+<br />

⎜<br />

⎜<br />

⎜<br />

⎝ P&<br />

− P&<br />

XG<br />

u<br />

P&<br />

YG<br />

u<br />

XG<br />

u<br />

⋅ tan λ<br />

R<br />

d<br />

R<br />

λd<br />

µ d<br />

R<br />

µ d<br />

⎞<br />

⎟<br />

⎟<br />

⎟<br />

⎟<br />

⎟<br />

⎟<br />

⎠<br />

Equation 3.3-3<br />

The Earth radii at point (d), adjusted for the geodetic height of point (u),<br />

used in the conversion of metres into radians are defined in §18.4 and §18.5.<br />

The LGA (G) to the Body frame (B) transform is obtained using spline-data<br />

in the functions defined in §22.4.1 and §22.4.7.<br />

T<br />

B<br />

G<br />

: =<br />

ϕ<br />

DC<br />

E<br />

E G G ZG<br />

( ϕLD<br />

( P&<br />

&<br />

u , P&<br />

u , gu<br />

) )<br />

From §19.5, the local gravitational acceleration at point (u) is,<br />

G<br />

u<br />

G<br />

d<br />

Equation 3.3-4<br />

( ) ( ) T<br />

ZE 2 ZG<br />

ω ⋅P<br />

⋅ cosλ<br />

⋅ 0 , − sin λ , cos<br />

g = − g + 3 ⋅<br />

λ<br />

C,<br />

E<br />

u<br />

d<br />

d<br />

d<br />

Equation 3.3-5<br />

The average angular body rate with respect to LGA over the 800 Hz subframe<br />

interval is obtained using the function defined in §22.5.3,<br />

ω<br />

B<br />

G , B<br />

≡<br />

ω<br />

B<br />

G,<br />

B<br />

AR<br />

B<br />

B<br />

( T ( t − ∆ ) , T , )<br />

: = ϕ<br />

∆<br />

G<br />

R<br />

G<br />

R<br />

Equation 3.3-6<br />

From the Navigation Equation the accelerometers sense specific<br />

acceleration comprising mass attraction and Earth centripetal acceleration<br />

components at point (u),<br />

f : = A − G : = A − g − ω × ω ×<br />

r, u<br />

r, u<br />

u<br />

r, u<br />

u<br />

C,<br />

E<br />

C,<br />

E<br />

P<br />

r,<br />

u<br />

Equation 3.3-7<br />

The acceleration of point (u) with respect to the Earth’s centre is obtained<br />

by applying the time rate of change operator twice with respect to LGA<br />

axes, expanding and combining with Equation 3.3-7,<br />

2<br />

I<br />

2<br />

( P ) : = ( D + ω ) ( P )<br />

D ×<br />

r,<br />

u<br />

G<br />

C,<br />

G<br />

r,<br />

u<br />

Equation 3.3-8

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

Saved successfully!

Ooh no, something went wrong!