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.

Appendix I / Utilities / Axis Transforms<br />

_ _<br />

RPY<br />

Ψ<br />

22.4-4<br />

B<br />

A<br />

: =<br />

0<br />

Equation 22.4-24<br />

B −15<br />

B −15<br />

RPY B<br />

( ΨA<br />

< 10 ) ∧ ( ΘA<br />

< 10 ) ⇒ EA<br />

: = 03<br />

22.4.4 Euler RP to Euler YP Transformation<br />

Equation 22.4-25<br />

RP_TO_YP takes the RPY Euler triplet defining the orientation of frame (B)<br />

with respect to frame (A) and returns the equivalent YPR Euler triplet.<br />

RP_TO_YP<br />

E<br />

B<br />

A<br />

: =<br />

RPY B B<br />

YP RPY B RPY B<br />

( E , E ) ≡ ϕ ( Φ , Θ )<br />

⎛<br />

⎜<br />

⎜<br />

⎜<br />

⎜<br />

⎜<br />

⎜<br />

⎝<br />

sin<br />

tan<br />

−1<br />

−1<br />

A<br />

A<br />

RP<br />

RPY B<br />

RPY B<br />

( sin ( Θ ) ⋅ cos(<br />

Φ ) )<br />

A<br />

0<br />

( ( ) ( ) ) ⎟⎟⎟⎟⎟⎟<br />

RPY B<br />

RPY B<br />

tan Θ ⋅ sin Φ<br />

A<br />

A<br />

A<br />

A<br />

A<br />

Equation 22.4-26<br />

⎞<br />

⎠<br />

Equation 22.4-27<br />

RPY B −15<br />

RPY B −15<br />

B<br />

( ΦA<br />

< 10 ) ∧ ( ΘA<br />

< 10 ) ⇒ EA<br />

: = 03<br />

22.4.5 Euler YP to Cartesian Transformation<br />

Equation 22.4-28<br />

YP_TO_XYZ takes the distance from point (a) to point (b), and the YPR<br />

Euler triplet defining the orientation of frame (B) with respect to frame (A),<br />

and returns the position of (b) with respect to (A).<br />

YP_TO_XYZ<br />

B A<br />

X<br />

B<br />

( P , E , P ) ≡ ϕ ( P , E )<br />

a,<br />

b<br />

22.4.6 Euler RP to Cartesian Transformation<br />

A<br />

b<br />

E<br />

a,<br />

b<br />

A<br />

Equation 22.4-29<br />

RP_TO_XYZ takes the distance from point (a) to point (b), and the RPY<br />

Euler triplet defining the orientation of frame (B) with respect to frame (A),<br />

and returns the Cartesian position of (b) with respect to (A).<br />

RP_TO_XYZ<br />

RPY B A<br />

( P , E , P )<br />

a,<br />

b<br />

A<br />

b<br />

Equation 22.4-30

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

Saved successfully!

Ooh no, something went wrong!