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

_ _<br />

B<br />

A<br />

Q<br />

DC<br />

B<br />

Q B G E<br />

( T ) ≡ ϕ ( T ⋅ T T )<br />

Q : = ϕ<br />

⋅<br />

A<br />

3.3-6<br />

DC<br />

G<br />

E<br />

A<br />

Equation 3.3-14<br />

Both frames (E) and (A) are Earth fixed, hence the angular rate and<br />

acceleration of frame (B) with respect to frame (A) is,<br />

B<br />

A,<br />

B<br />

ω<br />

ω& a ω&<br />

B<br />

A,<br />

B<br />

B<br />

A,<br />

B<br />

B<br />

G<br />

G<br />

E,<br />

G<br />

: = T ⋅ ω + ω<br />

R<br />

B<br />

G,<br />

B<br />

B B ( ω − ω ( t − ) )<br />

: = ∆ ⋅<br />

∆<br />

A,<br />

B<br />

A,<br />

B<br />

The position of point (u) with respect to the Alignment frame is,<br />

A<br />

u<br />

A<br />

E<br />

Equation 3.3-15<br />

R<br />

Equation 3.3-16<br />

( ) ( ) T<br />

E E G E<br />

G<br />

ZG<br />

P + T ⋅ P − P ; P 0 , 0 , P<br />

P : = T ⋅<br />

≡<br />

d<br />

G<br />

u<br />

o<br />

u<br />

Equation 3.3-17<br />

Equating the inertial velocity expressed in the Geodetic and Alignment<br />

frames,<br />

A<br />

u<br />

A<br />

E<br />

E<br />

G<br />

G G G E G<br />

A A E A<br />

( P&<br />

u + ωC,<br />

G ⋅ ( TE<br />

⋅ Pd<br />

+ Pu<br />

) ) + ωC,<br />

E ⋅ ( TE<br />

⋅ Po<br />

Pu<br />

)<br />

P & : = T ⋅ T ⋅<br />

+<br />

And similarly for the inertial acceleration of point (u),<br />

A<br />

u<br />

A<br />

E<br />

E<br />

G<br />

G<br />

u<br />

A<br />

C,<br />

E<br />

A<br />

u<br />

A<br />

C,<br />

E<br />

A<br />

C,<br />

E<br />

Equation 3.3-18<br />

A E A<br />

( T ⋅ P P )<br />

P &<br />

: = T ⋅ T ⋅ A − 2 ⋅ ω × P&<br />

− ω × ω × +<br />

G<br />

u<br />

G<br />

u<br />

G<br />

C,<br />

G<br />

G<br />

u<br />

G<br />

C,<br />

G<br />

G<br />

C,<br />

G<br />

E<br />

o<br />

Equation 3.3-19<br />

G E G<br />

( T ⋅ P P )<br />

A = P&<br />

& + 2 ⋅ ω × P&<br />

+ ω × ω × +<br />

3.3.1.2 IMU Reference Data Derived from the State Vector<br />

E<br />

d<br />

u<br />

Equation 3.3-20<br />

The average inertial angular rate over the 800 Hz sub-frame, expressed in<br />

terms of the state vector components,<br />

800<br />

ω<br />

B<br />

C,<br />

B<br />

B<br />

A<br />

A<br />

E<br />

E<br />

C,<br />

E<br />

AR<br />

B<br />

B<br />

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

: = T ⋅ T ⋅ ω + ϕ<br />

∆<br />

A<br />

R<br />

A<br />

R<br />

Equation 3.3-21<br />

u<br />

u

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

Saved successfully!

Ooh no, something went wrong!