Professional Documents
Culture Documents
Abstract
Currently, many six degree of freedom
(6-DOF) trajectory simulations and
simulations of gyroscopic motion use
quaternions to define a vehicles
orientation. Of those that do, however,
none take full advantage of the
properties of quaternion algebra.
Quaternions are also known as
hypercomplex numbers. They can be
treated as individual quantities for which
all the standard algebraic operations are
defined. Consequently, they have
advantages that Euler angles and
transformation matrices do not.
This paper will describe the use of
quaternion algebra and elliptic functions
to obtain a closed form solution for
torque free gyroscopic motion in terms
of the rotational quaternion and its
derivative. It will also define an
alternative 6-DOF formulation, that,
when combined with quaternion algebra,
is potentially much more powerful than
current simulations. Lastly, the paper
will present a special case of spin
stabilized rigid bodies.
Introduction
Review of Literature
George P. Davailus
q
q
q
Q
G
G
I
I 1
G
M
rotational quaternion
quaternion first derivative
quaternion second derivative
matrix of quaternion components
angular velocity vector
angular acceleration vector
mass moment of inertia matrix
inverse mass moment of inertia
moment vector
q
q
q
qe
a
b
G
u
G
w
Background
The computation of trajectories that
involve rigid body motion requires the
numerical solution of a large set of
ordinary differential equations.
x ( 0) = x 0
dx
= f ( x, t )
dt
For typical 6-DOF simulations, the
components of the unknown vector x
include the three components of angular
velocity vector roll, pitch, and yaw
and the four components of the
rotational quaternion. The quaternion
can represent a transformation of a
vector from one frame of reference or
coordinate system to another, often from
the rigid body frame to an inertial frame
or a reference frame, or vice-versa.
Depending on the trajectory, all of these
components can oscillate rapidly. The
relevant state equations are as follows. 3,
4
1 G
Q
2
G G
G
G
= I 1 ( M I )
q =
(1)
(2)
George P. Davailus
q 2
q
Q= 1
q4
q3
i +1 = 2QiT+1 q i +1
q3
q4
q1
q2
q4
q3
q2
q1
(3)
1 G
Q
2
1 G 1 G
q = Q + Q
2
2
(4)
(5)
Initial Conditions
Old 6-DOF Model
q0
G
1 = 2( q 2 q1 + q1 q 2 + q 4 q 3 q3 q 4 ) (7)
2 = 2( q3 q1 q 4 q 2 + q1 q 3 + q 2 q 4 ) (8)
3 = 2( q 4 q1 + q3 q 2 q 2 q 3 + q1q 4 ) (9)
q 0 =
Derivative Computations
Old 6-DOF Model
1 G
Q
2
G G
G
G
= I 1 ( M I )
q =
Numerical Integration
Old 6-DOF Model
Numerically integrate q to update q
Numerically integrate to update
George P. Davailus
(6)
1 G
Q
2
q =
G
1 G
(Q + Q )
2
G G
a b ab + u w
G = G G G K , i = 1 (14)
uG w
aw + bu + iu w
Note that quaternion multiplication is
not commutative.
Multiplicative Identity
1
qI = G
0
Addition
(11)
a
a
q = G = G
u
u
*
a b a b
G = G G
uG w
u w
Additive Identity
George P. Davailus
(12)
(16)
G G
2
det(q) = q = ab u w
(17)
Inverse
q*
det(q )
(18)
Division
q p=
Subtraction
(15)
Vector Conjugate
q 1 =
a b a + b
G = G G
uG + w
u + w
(13)
Multiplication
Quaternion Algebra
a
q = G
u
0
0G
q p*
det( p )
(19)
Exponentials
eq = ea (coshr + u sinhr) = ea (coss + u sins)
(20)
G
r = is = u 2
q (t + t ) = q (t ) e
0
q = G
q t
2
(21)
(22)
Square Roots
cos
cos sin
2
q =
cos sin
2
cos sin
2
1/ 2
cos
cos sin
4 (23)
=
cos sin
4
cos sin
4
Proof:
2 2 2
2
2
cos sin cos+cos +cos
4 4
=
cos
q q =
4 4
cos
cos
2
cos sin
cos sin
2
cos sin
2
(25)
(26)
(27)
(28)
(29)
1
1
q q q q2 = 0
4
2
(30)
(24)
George P. Davailus
q 2 = q 22 q 2
q1 =
G2
11
q1 2 q 2 1 q 3 2 q 4 3 (31)
22
11 G 2
11 G 2
11 G 2
q
=
q
2
qI q
q
q
2
det( I A) = q 2 + bq + cq I
q
q
2q q I
2
2
q =
2q I
(35)
(36)
(37)
(40)
a ( t ) dt
(41)
x = ax , where a is a constant.
(38)
1 = dn( p(t1 t 0 ), k )
2 = sn( p(t1 t 0 ), k )
3 = cn( p(t1 t 0 ), k )
(42)
(43)
(44)
dn ( pt , k ) dt
sn ( pt , k )
t0
cn ( pt , k )
t1
q (t1 ) = q (t 0 ) e
t0
q
dt
2
(39)
George P. Davailus
q (t1 ) = q(t 0 ) e
(45)
(48)
Mathematica website,
http://functions.wolfram.com/EllipticFun
ctions
[am(t1,k)am(t0 ,k)]
1
log(dn(t1,k) kcn(t1,k)) log(dn(t0 ,k) kcn(t0 ,k))
k
k
arccos(
arccos(
dn(t0 ,k)sn(t0 ,k))
dn
(
t
,
k
)
sn
(
t
,
k
))
1
1
2
2
1
dn
(
t
,
k
)
1
dn
(
t
,
k
)
1
0
q(t1) = q(t0 ) e
Results
Experimental results will be presented in
the final draft of a conference paper that
will be presented by the author at the
American Institute of Aeronautics and
Astronautics this August in San
Francisco.
References
1
George P. Davailus