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

_ _<br />

Expanding,<br />

q<br />

B<br />

A<br />

q<br />

q<br />

q<br />

B<br />

A<br />

B<br />

A<br />

B<br />

A<br />

⎛ Φ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

⎛ Θ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

( ) ⎟ ⎜ A ⎟ ⎜ A ⎟ ⎜ A ⋅ ⎟ + ⎜ A<br />

0 : = c ⋅ c c s ⎟ ⋅ s⎜<br />

A ⎟ ⋅ s⎜<br />

A<br />

⎛ Φ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

⎛ Θ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

22.10-2<br />

⎛ Ψ<br />

⎜<br />

⎝ 2<br />

⎛ Ψ<br />

⎜<br />

⎝ 2<br />

B<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

⎛ Φ<br />

⎜<br />

⎝ 2<br />

⎛ Φ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

⎛ Θ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

⎛ Ψ<br />

⎜<br />

⎝ 2<br />

B<br />

Equation 22.10-6<br />

⎛ Θ<br />

⎜<br />

⎝ 2<br />

⎛ Ψ<br />

⎜<br />

⎝ 2<br />

( ) ⎟ ⎜ A ⎟ ⎜ A ⎟ ⎜ A ⋅ ⎟ − ⎜ A<br />

1 : = s ⋅ c c c ⎟ ⋅ s⎜<br />

A ⎟ ⋅ s⎜<br />

A<br />

⎛ Φ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

⎛ Θ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

⎛ Ψ<br />

⎜<br />

⎝ 2<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

⎛ Φ<br />

⎜<br />

⎝ 2<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

Equation 22.10-7<br />

⎛ Θ<br />

⎜<br />

⎝ 2<br />

⎛ Ψ<br />

⎜<br />

⎝ 2<br />

( ) ⎟ ⎜ A ⎟ ⎜ A ⎟ ⎜ A ⋅ ⎟ + ⎜ A<br />

2 : = c ⋅ s c s ⎟ ⋅ c⎜<br />

A ⎟ ⋅ s⎜<br />

A<br />

⎛ Φ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

⎛ Θ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

⎛ Ψ<br />

⎜<br />

⎝ 2<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

⎛ Φ<br />

⎜<br />

⎝ 2<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

Equation 22.10-8<br />

⎛ Θ<br />

⎜<br />

⎝ 2<br />

⎛ Ψ<br />

⎜<br />

⎝ 2<br />

( ) ⎟ ⎜ A ⎟ ⎜ A ⎟ ⎜ A ⋅ ⎟ − ⎜ A<br />

3 : = c ⋅ c s s ⎟ ⋅ s⎜<br />

A ⎟ ⋅ c⎜<br />

A<br />

22.10.3 Quaternion Product<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

⎞<br />

⎟<br />

⎠<br />

B<br />

Equation 22.10-9<br />

Q_PRODUCT takes quaternions representing the orientation of frame (B)<br />

with respect to frame (B), and frame (C) with respect to (B), and returns the<br />

quaternion product representing the transformation from (A) to (C).<br />

Q_PRODUCT<br />

The product of two quaternions is,<br />

B C C<br />

( Q , Q , Q )<br />

A<br />

B<br />

A<br />

Equation 22.10-10<br />

C B<br />

C B C B C B<br />

C B<br />

( q ( 0 ) ⋅ q ( 0 ) − q • q , q ( 0 ) ⋅ q + q ⋅ q ( 0 ) − q × q )<br />

B<br />

Expanding,<br />

q<br />

C<br />

A<br />

A<br />

B<br />

A<br />

Q<br />

C<br />

B<br />

⊗<br />

Q<br />

B<br />

B<br />

A<br />

: =<br />

A<br />

B<br />

A<br />

B<br />

A<br />

Equation 22.10-11<br />

C B<br />

C B<br />

C B<br />

C B<br />

( 0 ) : = q ( 0 ) ⋅ q ( 0 ) − q ( 1 ) ⋅ q ( 1 ) − q ( 2 ) ⋅ q ( 2 ) − q ( 3 ) ⋅ q ( 3 )<br />

B<br />

A<br />

B<br />

A<br />

B<br />

A<br />

B<br />

A<br />

Equation 22.10-12<br />

⎞<br />

⎠<br />

⎞<br />

⎠<br />

⎞<br />

⎠<br />

⎞<br />

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

Saved successfully!

Ooh no, something went wrong!