multibody dynamics equations of motion for unconstrained
TRANSCRIPT
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 1/20
Multibody Dynamics
Equations of Motion for Unconstrained Systems Using Relative Coordinates with Euler Parameters
As mentioned in previous notes, the explicit form
of the equations of motion of a multibody system
depends on:
o choice of generalized coordinates
o choice of generalized speeds
o method used to formulate equations
o constraints on system motion
In these notes, Kane’s equations are used to derive the
equations of motion of a multibody system using
relative coordinates to describe the relative
orientation and relative translation between
adjoining bodies.
Using relative coordinates, the kinematic analysis is generally more complicated, but the constraints between
adjoining bodies are usually more straight-forward to formulate. Recursive relationships can be developed for
kinematic variables to streamline the analysis.
In the analysis that follows, the relative orientations and angular velocities of bodies are described using
Euler parameters and angular velocity components. As discussed in previous notes, a body-connection array is
used as an aid when developing the kinematic and dynamic equations of motion. For convenience (and without
loss of generality), it is assumed herein that the bodies are numbered starting with “1” as the reference body and
increasing the body numbers while moving outward along the branches, so a body’s lower-body is also a lower-
numbered body.
Generalized Coordinates and Speeds
The generalized coordinates and generalized speeds for a system with “ N ” bodies are listed below.
o Euler parameters ˆ ( 1, , ; 1,2,3,4)Ki K N i = = are used to measure the orientations of the bodies
relative to their adjacent, lower bodies. So, the Euler parameters ˆ ( 1,2,3,4)Ki i = measure the
orientation of body K relative to body ( )KL .
o Translation variables ( 1, , ; 1,2,3)Kis K N i = = are used to measure displacements of the bodies
relative to their adjacent, lower bodies. These variables represent the lower-body-frame components
of the translation vectors of the bodies ( )Ks .
o Relative angular velocity components ˆ ( 1, , ; 1,2,3)Ki K N i = = are used to measure the angular
velocities of the bodies relative to their adjacent, lower bodies. These are the body-frame components
of the relative angular velocity vectors of the bodies ( )( )ˆ K
K K L .
Multibody System with Eight Bodies
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 2/20
As described, there are “ 7N ” generalized coordinates, ˆ ( 1, , ; 1,2,3,4)Ki K N i = = and
( 1, , ; 1,2,3)Kis K N i = = . To avoid the use of Lagrange multipliers, the “ 6N ” generalized speeds are defined
to be ˆ ( 1, , ; 1,2,3)Ki K N i = = and ( 1, , ; 1,2,3)Kis K N i = = .
System State Vectors
Using the generalized coordinates and speeds defined above, the following system state vectors can be
defined.
11 12 13 14 1 2 3 4 1 2 3 44 1
ˆ
ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ[ , , , , , , , , , , , , , ]T
K K K K N N N NN
T
K
=
11 12 13 1 2 3 1 2 33 1[ , , , , , , , , , , ]T
K K K N N NN
T
Ks
s s s s s s s s s s
=
11 12 13 1 2 3 1 2 33 1
ˆ
ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ[ , , , , , , , , , , ]T
K K K N N NN
T
K
=
and
1 4 1
7 12 3 1
ˆN
N
N
xx
sx
= =
1 3 1
6 12 3 1
ˆN
N
N
yy
sy
= =
(1)
Transformation Matrices
Consider two bodies of the multibody system. Body J is the adjacent,
lower body of body K, that is, ( )J K=L . The unit vectors of the two bodies
can be written in terms of the inertial frame vectors using the body
transformation matrices.
Je R N = Kn R N =
Using these two results, the unit vectors in body K can be written in terms
of the unit vectors of body J as follows
T
J
K K J Kn R N R R e R e = = (2)
where J
KR is the relative transformation matrix used to write the unit vectors of body K in terms of the unit
vectors of body J.
T
J
K K JR R R
Or, multiplying both sides of the equation on the right by JR gives
J
K K JR R R = (3)
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 3/20
The relative transformation matrix J
KR can be written in terms of the Euler parameters as follows.
2 2 2 2
1 2 3 4 1 2 3 4 1 3 2 4
2 2 2 2
1 2 3 4 1 2 3 4 2 3 1 4
2 2 2
1 3 2 4 2 3 1 4 1 2 3
ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ( ) 2( ) 2( )
ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ2( ) ( ) 2( )
ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ2( ) 2( ) (
K K K K K K K K K K K K
J
K K K K K K K K K K K K K
K K K K K K K K K K K
R
− − + + −
= − − + − + + + − − − + + 2
4 )K
(4)
The result in Eq. (3) is easily extended to include as many bodies as necessary to move from a body-frame to a
fixed-frame through frames of a series of interconnected bodies.
2
1
( ) ( ) ( )
( ) ( ) ( )
K
K K
u
u u
K K K
K K K K KR R R R R−
= L L L
L L L (5)
Recall that ( ) 1KuK =L refers to the reference body of the system.
Time-Derivatives of the Transformation Matrices
In previous notes, the time derivatives of the transformation matrices from the bodies to the inertial frame
were written in terms of skew-symmetric matrices formed from the components of the angular velocities of the
bodies relative to the fixed frame. Recall that the “prime” indicates the use of body-frame components.
T
K K KR R = (components of R
K are resolved in body K ) (6)
The time derivatives of the transformation matrices between bodies in the system were written in terms of skew-
symmetric matrices formed from components of the angular velocities of the bodies relative to their adjacent,
lower bodies. In the formula that follows, body J is the lower body of body K, and the “prime” indicates
components resolved in body K.
T
J J J
K K KR R = (components of J
K are resolved in body K ) (7)
Relative Angular Velocity Components and Euler Parameters
The relative angular velocity components of body K can be written in terms of its Euler parameters as follows
14 3 2 11
3 4 1 2 22
2 1 4 33 3
1 2 3 44
ˆˆ ˆ ˆ ˆˆ
ˆ ˆ ˆ ˆ ˆˆˆ ˆ2 2
ˆ ˆ ˆ ˆˆ ˆ
ˆ ˆ ˆ ˆ0 ˆ
KK K K KK
K K K K KK
K K
K K K KK K
K K K KK
E
− − − − = − −
(8)
Note the last equation is simply the derivative of the Euler parameter constraint equation, 2 2 2 2
1 2 3 4ˆ ˆ ˆ ˆ 1 + + + = .
The matrix ˆKE
is an orthogonal matrix, so the above equation can be easily inverted to give
12 4 1
ˆˆ ˆT
K K KE
=
(9)
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 4/20
The subscript “ 4 1 ” has been added as a reminder that zero has been added as the fourth element of the angular
velocity column vector. In practice, the fourth column of ˆT
KE
and the fourth row of 4 1
ˆK can be eliminated
(because the fourth element of 4 1
ˆK is zero).
Angular Velocity and Partial Angular Velocity
The angular velocity of body K can be found using the summation rule for angular velocities and the body-
connection array.
1
0 1
1 ( ) ( ) ( )( )ˆ ˆ ˆ ˆ ˆ ˆ ˆ ˆ
K
K K
u i i
R R
K K K K J KK KKi u i u
−
= =
= + + + + = = + = + L L LL (10)
Regarding the body-connection array, recall that 0 ( )K K=L , ( )1( )K K=L L , ( )2 ( ) ( )K K=L L L , etc.
Using Eq. (10), the angular velocities of the bodies in the system can be developed starting with the reference
body and then radiating outward through the branches of the system. Resolving the components of R
K and ˆK
in body K and the components of R
J in body ( )J K=L , Eq. (10) can be rewritten in component form as
ˆR J R
K K J KR = + (11)
Here, the relative transformation matrix J
KR transforms the components of the angular velocity vector of body
J into the body K reference frame.
Eq. (10) can be differentiated to find a recursive equation for the partial angular velocities as well. These
partial derivatives are non-zero only for 1, ,3p N= , and they are zero for 3p N .
ˆR R
K J K
p p py y y
= +
(12)
Note that the partial derivatives of the relative angular velocity ˆK are non-zero only for
(3 2),(3 1),3p K K K= − − . So, the partial angular velocities of body K can be calculated as
( )1, , (3 3)
R R
K J
p p
p Ky y
= = −
( )
( )
( )
1
2
3
3 2
3 1
3
R
K
p
n p K
n p Ky
n p K
= −
= = −
=
( )0 3
R
K
p
p Ky
=
(13)
Note (as assumed above) if the bodies are numbered starting with “1” as the reference body and increasing
numbers while moving outward along the branches, the angular velocity of a body will not depend on the
variables associated with higher-numbered bodies.
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 5/20
Eq. (12) can be written in component form as follows.
, , ,3 6
ˆR J R
K y K J y K yNR
= + (14)
Here, the relative transformation matrix J
KR transforms the components of the partial angular velocity
vectors of body J (which are resolved in the body J frame) into the body K reference frame. The partial relative
angular velocity matrix ,ˆ
K y of body K can be partitioned into “ 2N ” 3 3 matrices as follows.
, 3 33 6
1 1 1 1 2 1 1 1
ˆ [0],[0], ,[0],[ ],[0], ,[0],[0],[0], ,[0] [0],[0], ,[0],[ ],[0], ,[0],[0]K y NNK K K N N N K K K N
I I − + + − +
= =
(15)
All 3 3 partitions are zero except the one in the thK partition which is the 3 3 identity matrix.
Note the partial angular velocity matrix ,
R
J y and the subsequent product ,
J R
K J yR can also be
partitioned into “ 2N ” 3 3 matrices which may be non-zero in partitions 1 ( 1)K→ − , but are zero everywhere
else. Hence, the matrix summation indicated in Eq. (14) need not actually be done. The partial angular velocity
matrix for body K can be formed by simply changing the thK partition of the product ,
J R
K J yR to an
identity matrix.
Note finally, that the body-frame components of the angular velocities of the bodies can now be written in
terms of the partial angular velocity matrices as follows.
1 2
1 3 1, , ,6 13 6 3 3 3 3
2 3 1
R R R R NK K y K y K yNN N N
N
yy
y
= = (16)
The last part Eq. (16) is written in partitioned form, separating the parts associated with the elements of 1y from
those associated with 2y . Noting that all the elements of 2,
3 3
R
K yN
are zero, this equation can be further
simplified to give
1 2 1, 1 , 2 , 1
R R R R
K K y K y K yy y y = + = (17)
Even this final product can be further simplified by noting that many of the elements of 1,
R
K y are also zero,
so they may be ignored in the product.
Angular Acceleration
The angular accelerations of the bodies are found by differentiating the angular velocities either in the
inertial frame or in the body frame.
( ) ( )R K
R R R
K K K
d d
dt dt = =
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 6/20
The body-fixed components of R
K the angular acceleration of body K are found by differentiating the body-
fixed components of the angular velocity of body K in Eq. (17).
1 1
, ,
, 1 , 1
R R
K K
R R
K y K y
R R
K y K y
y y
y y
=
= +
= +
Here,
1 1 1 1, , , ,
3 3
zero
ˆR J R J R
K y K J y K J y K yN
R R
= + +
1 1 1, , ,
3 3
TR J R J J R
K y K J y K K J yN
R R
= + (18)
Eq. (18) provides a recursive relationship for finding the time derivatives of the partial angular velocity matrices.
Recall, from above that 2,
3 3
R
K yN
is a zero matrix, so
2,3 3
R
K yN
is also a zero matrix.
Mass-Center Position Vectors
Consider a typical branch of a multibody system as
shown in the diagram. Each body K has a mass-center
KG , an origin KO , and a reference point
KQ . The
points KG and
KO are fixed in body K, and the point
KQ is fixed in the adjacent, lower body J ( )( )J K=L .
The point KO is positioned relative to
JO the origin of
body J by the position vectors Kq and Ks .
The position vector of KO relative to the inertial
system can be written as
K JO O K Kp p q s= + + ( )1, ,K N= (19)
Given that 1 1Op s= ( )1 0q , Eq. (19) is a recursive relationship that can be used to build the position vectors of
the origins of all the bodies of the system. The components of KOp are resolved in the body K fixed system, but
the components of JOp , Kq , and
Ks are all resolved in body J. So, Eq. (19) can be written in component form
as
( )K J
J
O K O K Kp R p q s = + + (20)
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 7/20
Finally, resolving the components of Kr in body K, the body-frame components of the mass-center position
vectors can be written as
( ) K K J
J
G O K K O K K Kp p r R p q s r = + = + + + (21)
Consider now the eight-body example system. Using
Eq. (21), the position vectors of the mass-centers of the
bodies can be written in component form as follows.
1 1 1
1 1 1
G Op p r
R s r
= +
= +
( )
( )
2 1
1
2 2 2 2
1
2 1 1 2 2 2
G Op R p q s r
R R s q s r
= + + +
= + + +
( )
( ) ( )
3 2
2
3 3 3 3
2 1
3 2 1 1 2 2 3 3 3
G Op R p q s r
R R R s q s q s r
= + + +
= + + + + +
( ) ( ) 4 1
1 1
4 4 4 4 4 1 1 4 4 4G Op R p q s r R R s q s r = + + + = + + +
( )
( ) ( )
5 2
2
5 5 5 5
2 1
5 2 1 1 2 2 5 5 5
G Op R p q s r
R R R s q s q s r
= + + +
= + + + + +
( ) ( ) 16
1 1
6 6 6 6 6 1 1 6 6 6G Op R p q s r R R s q s r = + + + = + + +
( ) ( ) 7 1
1 1
7 7 7 7 7 1 1 7 7 7G Op R p q s r R R s q s r = + + + = + + +
( )
( ) ( )
8 7
7
8 8 8 8
7 1
8 7 1 1 7 7 8 8 8
G Op R p q s r
R R R s q s q s r
= + + +
= + + + + +
Mass-Center Velocities
The velocities of the mass-centers of the bodies can be found by first finding the velocities of the origins of
the bodies. This can be done as follows.
( ) ( ) ( )K J
K J J
R RR R RO OR R
O O K K K K O K K
d p d pd d dv p q s q s v q s
dt dt dt dt dt= = + + = + + = + +
The last term can be expanded using the derivative rule (that relates the derivatives of a vector in different
reference frames) as follows.
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 8/20
( ) ( ) ( ) ( ) ( )R J J
R R
K K K K J K K K J K K
d d dq s q s q s s q s
dt dt dt + = + + + = + +
Combining these two results gives
( ) ( )K J
JR R R
O O K J K K
dv v s q s
dt= + + + (22)
Eq. (22) can be written in component form as follows.
( )
K J
R J R R
O J O K J K Kv R v s q s = + + + L (23)
Here, J
R
Ov are components of J
R
Ov in body ( )JL , and K
R
Ov are the components of K
R
Ov in body
( )J K=L . This result allows the velocities of the origins of the bodies to be calculated recursively, starting with
the velocity of 1O , the origin of body 1, the reference body.
Given the velocities of the origins of the bodies, the velocities of the mass-centers of the bodies can be
calculated as follows.
( )K K
R R R
G O K Kv v r= + (24)
Resolving the components of K
R
Gv in body K, the above equation can be written in component form as follows.
K K
R J R R
G K O K Kv R v r = + (25)
Mass-Center Partial Velocities
The partial velocities of the mass centers of the bodies can be written in terms of the partial velocities of the
origins of the bodies. To this end, rewrite Eq. (23) as follows.
( )
( )( )
( )
( )
, , ,
( )
, , ,
,
J
J K
J K
K
K
R J R R
O J O K J K K
J R R J
J O y K K J y O y
J R R J
J O y K K J y O y
R
O y
v R v s q s
R v y q s y v y
R v q s v y
v y
= + + +
= − + +
= − + +
L
L
L
( )( )
, , , ,K J K
R J R R J
O y J O y K K J y O yv R v q s v = − + + L (26)
Here, ,3 6J
R
O yN
v
and ,3 6K
R
O yN
v
are the partial velocity matrices of the origin points JO and
KO , and
,K
J
O yv
can be partitioned and defined as follows.
1 2 2, , , ,3 33 6 3 3 3 3 3 3
0K K K K
J J J J
O y O y O y O yNN N N Nv v v v
= =
(27)
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 9/20
with
2,
3 31 1 1
[0], ,[0],[ ],[0], ,[0]K
J
O yN
K K K N
v I
− +
=
(28)
In Eq. (28), [0] represents the 3 3 zero matrix, and [ ]I represents the 3 3 identity matrix.
Eqs. (26)-(28) provide a means to recursively calculate the partial velocity matrices of the origins of the
bodies. Using this result, the partial velocity matrices of the mass-centers of the bodies can be calculated as
follows. Returning to Eq. (25), write
( )
, ,
,
K K
K
K
K
R J R R
G K O K K
J R R
K O K K
J R R
K O y K K y
R
G y
v R v r
R v r
R v r y
v y
= +
= −
= −
(29)
, , ,K K
R J R R
G y K O y K K yv R v r = − (30)
Mass-Center Accelerations
The accelerations of the mass-centers of the bodies can be found by differentiating the velocities using the
derivative rule. That is,
( )K K
K
R R K R
G G R R
K G
d v d vv
dt dt= +
This result can be expressed in component form as
, ,
K K K
K K K
R R R R
G G K G
R R R R
G y G y K G
a v v
v y v y v
= +
= + +
(all components in body K)
Using Eq. (30), the time derivatives of the partial velocities of the mass-centers can be written as follows.
, , , ,
, , ,
K K K
K K
R J R J R R
G y K O y K O y K K y
TJ R J J R R
K O y K K O y K K y
v R v R v r
R v R v r
= + −
= + −
(31)
Using Eq. (26), the time derivatives of the partial velocities of the origins of the bodies can be calculated as
follows.
( )( ) ( )
, , , , , ,
zero
K J J K
R J R J R R R J
O y J O y J O y K J y K K J y O yv R v R v s q s v = + − − + + L L
or
( )( ) ( ) ( )
, , , , ,K J J
TR J R J J R R R
O y J O y J J O y K J y K K J yv R v R v s q s = + − − + L L L
(32)
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 10/20
This result allows the time derivatives of the partial velocities of the origins of the bodies to be calculated in
terms of the time derivatives of the partial velocities of the origins of the lower bodies.
Generalized Forces
Let the forces and torques acting on each body of the system be replaced by an equivalent force system
consisting of a single force KF acting at the mass-center KG and a single moment KM . Then the generalized
forces for the system can be calculated as
1
K
i
RNG K
y K K
K i i
vF F M
y y
=
= + (33)
or, in component form, the column vector of generalized forces is
, ,6 11
K
N T TR R
y G y K K y KNK
F v F M
=
= + (34)
where KF represents the body K components of the force-vector KF and KM represents the body K
components of the moment-vector KM .
Equations of Motion of the Unconstrained System
Assuming all “ 6N ” of the generalized speeds are independent, Kane’s equations of motion for the multibody
system can be written as
( ) ( )1 1
K
K K K i
RN NG R R K
K G G K K G y
K Ki i
vm a I H F
y y
= =
+ + = ( 1, ,6 )i N= (35)
Here, the generalized forces on the right side of the equation are the entries of the generalized force column vector
of Eq. (34). The terms on the left side of the equation can be written as follows.
1. , ,K K K K K
R R R R R
G G G y G y K Ga a v y v y v → = + +
2. 1 1, 1 , 1K
R R R R R
K K K y K yy y → = = +
3. 1
K
K
NG
K G
K i
vm a
y=
→
, , ,
1 1
, ,
1
,
1
K K K K
K K
K K
N NT TR R R R
K G y G K G y G y
K K
N TR R
K G y G y
K
N TR R R
K G y K G
K
m v a m v v y
m v v y
m v v
= =
=
=
=
+
+
(36)
4. ( )1
K
RNKR
G K
K i
Iy
=
→
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 11/20
( ) ( )( )1 1, , , 1 , 1
1 1K K
N NT T
R R R R R
K y G K K y G K y K y
K K
I I y y = =
= + (37)
5. { }K K
R R R
K G K G KH I → (body-fixed components)
6. ( ) ,
1 1K K
RN NTKR R R R
K G K y K G K
K Ki
H Iy
= =
→
(38)
Substituting from Eqs. (34) and (36)-(38) into Eq. (35) gives
, , , ,
1
, , , ,
1 1
, ,
1
K K K
K K K
K K
N T TR R R R
K G y G y K y G K y
K
N NT TTR R R R
G y K K y K K G y G y
K K
N TR R R R
K G y K G K y
K
m v v I y
v F M m v v y
m v v
=
= =
=
+
= + −
− −
( )
,
1
,
1
K
K
NT
R
G K y
K
NT
R R R
K y K G K
K
I y
I
=
=
−
The above result can be written in the final matrix form
A y f= ([ ]A is called the “generalized mass matrix”) (39)
Here,
, , , ,
1K K K
N T TR R R R
K G y G y K y G K y
K
A m v v I =
= + (40)
( )
, , , ,
1 1
, , ,
1 1
,
1
K K K
K K K
K
N NT TTR R R R
G y K K y K K G y G y
K K
N NT TR R R R R
K G y K G K y G K y
K K
NT
R R R
K y K G K
K
f v F M m v v y
m v v I y
I
= =
= =
=
= + −
− −
−
(41)
Eq. (39) represents “ 6N ” first-order, ordinary differential equations for the “13N ” variables defined by the
system state vectors { }x and { }y of Eq. (1). To form a complete set of differential equations, Eq. (39) must be
supplemented with Eqs. (42) and (43) which are a set of “ 7N ” first-order, kinematical differential equations.
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 12/20
1 1
1
2 2 2
1 33 3
1 12 2
ˆ [0] [0] [0] [0]ˆ
ˆ [0] [0] [0] ˆ
ˆ ˆˆ [0] [0] [0]
[0] [0]ˆ
ˆ [0] [0] [0] [0]
T
T
T
NT
N N
E
E
x E
E
= = = =
ˆT
E (42)
and
2 2x y= (43)
The matrices T
KE that appear on the diagonal of Eq. (42) can be found from Eq. (8).
4 3 2
3 4 1
2 1 4
1 2 3
ˆ ˆ ˆ
ˆ ˆ ˆ
ˆ ˆ ˆ
ˆ ˆ ˆ
K K K
T K K K
K
K K K
K K K
E
−
− = − − − −
( )1, ,K N= (44)
Note that T
KE is formed from ˆ
T
KE (as defined by Eq. (8)) by removing its fourth column. This allows the
angular velocity vectors ˆK to be taken as 3 1 vectors and the vector ̂ is a 3 1N vector. Recall that, for
convenience, the angular velocity vector of Eq. (8) was treated as a 4 1 vector whose last element was zero
which made it easy to invert the equation and solve for the derivatives of the Euler parameters.
Example Eight-Body System
As an example of how to create the kinematical
quantities required to generate the equations of motion
(39)-(41) of a multibody system, consider the eight-body
system shown in the diagram. The equations provided
above are used below to generate the angular velocities
and partial angular velocities of the bodies and their time
derivatives and the velocities and partial velocities of the
mass centers of the bodies and their time derivatives.
Eq. (11) states that the angular velocity of a body K
can be written in terms of the angular velocity of its
adjacent, lower body J.
ˆR J R
K K J KR = + ˆ J
K K (prime indicates body-frame components)
Multibody System with Eight Bodies
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 13/20
This result allows the angular velocities to be calculated recursively, starting with the reference body of the
system.
1 1ˆR = (components in body 1)
1
2 2 1 2ˆR RR = + (components in body 2)
2
3 3 2 3ˆR RR = + (components in body 3)
1
4 4 1 4ˆR RR = + (components in body 4)
2
5 5 2 5ˆR RR = + (components in body 5)
1
6 6 1 6ˆR RR = + (components in body 6)
1
7 7 1 7ˆR RR = + (components in body 7)
7
8 8 7 8ˆR RR = + (components in body 8)
Eq. (14) states that the partial angular velocity of a body K can be written in terms of the partial angular
velocity of its adjacent, lower body J.
, , ,3 6
ˆR J R
K y K J y K yNR
= + (prime indicates body-frame components)
Applying this equation to the example eight-body system gives
1, 1, 3 243 48ˆ [ ], [0], [0], [0], [0], [0], [0], [0],[0]R
y y I = =
1 1
2, 2 1, 2, 2 3 243 48ˆ , [ ], [0], [0], [0], [0], [0], [0],[0]R R
y y yR R I = + =
2 2 1 2
3, 3 2, 3, 3 2 3 3 243 48ˆ , , [ ], [0], [0], [0], [0], [0],[0]R R
y y yR R R R I = + =
1 1
4, 4 1, 4, 4 3 243 48ˆ , [0], [0], [ ], [0], [0], [0], [0],[0]R R
y y yR R I = + =
2 2 1 2
5, 5 2, 5, 5 2 5 3 243 48ˆ , , [0], [0], [ ], [0],[0], [0],[0]R R
y y yR R R R I = + =
1 1
6, 6 1, 6, 6 3 243 48ˆ , [0], [0], [0], [0], [ ], [0], [0],[0]R R
y y yR R I = + =
1 1
7, 7 1, 7, 7 3 243 48ˆ , [0], [0], [0], [0], [0], [ ], [0],[0]R R
y y yR R I = + =
7 7 1 7
8, 8 7, 8, 8 7 8 3 243 48ˆ , [0], [0], [0], [0], [0], , [ ],[0]R R
y y yR R R R I = + =
Although these results were generated using Eq. (14), they are the same as those found by simply differentiating
the expressions for the angular velocities.
Eq. (18) states that the time-derivative of the partial angular velocity of body K can be written in terms the
time-derivative of the partial angular velocity of its adjacent, lower body J as follows.
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 14/20
1 1 1 2, , , ,
3 3 3 30
TR J R J J R R
K y K J y K K J y K yN N
R R
= + =
Applying this equation to the example eight-body system gives the following.
11, 3 243 24
0R
y
=
1 1 1 1
1 1 1 1 1
2, 2 1, 2 2 1, 2 2 1,3 24
1 1
2 2 , [0], [0], [0], [0], [0], [0], [0]
T TR R R R
y y y y
T
R R R
R
= + =
=
1 1 1
2 2 2
3, 3 2, 3 3 2,3 24
2 1 1
3 2 2
2 2 1
3 3 2
, [0], [0], [0], [0], [0], [0], [0]
, [ ], [0], [0], [0], [0], [0], [0]
TR R R
y y y
T
T
R R
R R
R R I
= +
=
+
1 1 1 1
1 1 1 1 1
4, 4 1, 4 4 1, 4 4 1,3 24
1 1
4 4 , [0], [0], [0], [0], [0], [0], [0]
T TR R R R
y y y y
T
R R R
R
= + =
=
1 1 1
2 2 2
5, 5 2, 5 5 2,3 24
2 1 1
5 2 2
2 2 1
5 5 2
, [0], [0], [0], [0], [0], [0], [0]
, [ ], [0], [0], [0], [0], [0], [0]
TR R R
y y y
T
T
R R
R R
R R I
= +
=
+
1 1 1 1
1 1 1 1 1
6, 6 1, 6 6 1, 6 6 1,3 24
1 1
6 6 , [0], [0], [0], [0], [0], [0], [0]
T TR R R R
y y y y
T
R R R
R
= + =
=
1 1 1 1
1 1 1 1 1
7, 7 1, 7 7 1, 7 7 1,3 24
1 1
7 7 , [0], [0], [0], [0], [0], [0], [0]
T TR R R R
y y y y
T
R R R
R
= + =
=
1 1 1
7 7 7
8, 8 7, 8 8 7,3 24
7 1 1
8 7 7
7 7 1
8 8 7
, [0], [0], [0], [0], [0], [0], [0]
, [0], [0], [0], [0], [0], [ ], [0]
TR R R
y y y
T
T
R R
R R
R R I
= +
=
+
These results are the same as those found by simply differentiating the expressions for the partial angular
velocities.
Eq. (23) states that the velocity of the origin of body K can be written in terms of the velocity of the origin of
its adjacent, lower body as follows.
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 15/20
( )
K J
R J R R
O J O K J K Kv R v s q s = + + + L
Eq. (25) states that the velocity of the mass-center of body K can be written in terms of the velocity of the origin
of the body as follows.
K K
R J R R
G K O K Kv R v r = +
Applying these equations to the example eight-body system gives the following.
1 1
R
Ov s =
1 11 1 1 1
R R R R
G O K K Kv R v r R s r = + = +
2 11 2 1 2 2 1 1 2 1 2 2
R R R R
O Ov R v s q s R s s q s = + + + = + + +
( )
2 2
1
2 2 2
1
2 1 1 2 1 2 2 2 2
R R R
G O
R R
v R v r
R R s s q s r
= +
= + + + +
( ) 3 2
1
2 3 2 3 3
1
2 1 1 2 1 2 2 3 2 3 3
R R R
O O
R R
v R v s q s
R R s s q s s q s
= + + +
= + + + + + +
( ) ( )
3 3
2
3 3 3
2 1
3 2 1 1 2 1 2 2 3 2 3 3 3 3
R R R
G O
R R R
v R v r
R R R s s q s s q s r
= +
= + + + + + + +
4 11 4 1 4 4 1 1 4 1 4 4
R R R R
O Ov R v s q s R s s q s = + + + = + + +
( ) 4 4
1 1
4 4 4 4 1 1 4 1 4 4 4 4
R R R R R
G Ov R v r R R s s q s r = + = + + + +
( ) 5 2
1
2 5 2 5 5
1
2 1 1 2 1 2 2 5 2 5 5
R R R
O O
R R
v R v s q s
R R s s q s s q s
= + + +
= + + + + + +
( ) ( )
5 5
2
5 5 5
2 1
5 2 1 1 2 1 2 2 5 2 5 5 5 5
R R R
G O
R R R
v R v r
R R R s s q s s q s r
= +
= + + + + + + +
6 11 6 1 6 6 1 1 6 1 6 6
R R R R
O Ov R v s q s R s s q s = + + + = + + +
( ) 6 6
1 1
6 6 6 6 1 1 6 1 6 6 6 6
R R R R R
G Ov R v r R R s s q s r = + = + + + +
7 11 7 1 7 7 1 1 7 1 7 7
R R R R
O Ov R v s q s R s s q s = + + + = + + +
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 16/20
( ) 7 7
1 1
7 7 7 7 1 1 7 1 7 7 7 7
R R R R R
G Ov R v r R R s s q s r = + = + + + +
( ) 8 7
1
7 8 7 8 8
1
7 1 1 7 1 7 7 8 7 8 8
R R R
O O
R R
v R v s q s
R R s s q s s q s
= + + +
= + + + + + +
( ) ( )
8 8
7
8 8 8
7 1
8 7 1 1 7 1 7 7 8 7 8 8 8 8
R R R
G O
R R R
v R v r
R R R s s q s s q s r
= +
= + + + + + + +
Eqs. (26)-(28) state that the partial velocity of the origin of body K can be written in terms of the partial
velocity of the origin of its adjacent, lower body J as
( )( )
, , , ,K J K
R J R R J
O y J O y K K J y O yv R v q s v = − + + L
where the last term ,K
J
O yv
can be partitioned and defined as
1 2 2, , , ,3 33 6 3 3 3 3 3 3
0K K K K
J J J J
O y O y O y O yNN N N Nv v v v
= =
with 2,
3 3K
J
O yN
v
defined in a partitioned form as follows.
2,
3 31 1 1
[0], ,[0],[ ],[0], ,[0]K
J
O yN
K K K N
v I
− +
=
Applying these equations to the example eight-body system gives the following.
1 1 1 2, , ,3 24 3 243 48 3 24
0 0 ,[ ],[0],[0],[0],[0],[0],[0],[0]R R J
O y O y O yv v v I
= = =
1 1, 1 , 1 1,3 48
1 1 3 243 240 , , [0], [0], [0], [0], [0], [0], [0] , [0], [0], [0], [0], [0], [0], [0],[0]
R R R
G y O y yv R v r
R r
= −
= −
( )
( )
2 1 2
1
, 1 , 2 2 1, ,3 48
13 24
2 2 3 24
3 24
0 , , [0], [0], [0], [0], [0], [0], [0]
, [0], [0], [0], [0], [0], [0], [0],[0]
0 ,[0],[ ], [0], [0], [0], [0], [
R R R
O y O y y O yv R v q s v
R
q s
I
= − + +
=
− +
+ 0], [0]
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 17/20
( )
2 2
1
, 2 , 2 2,3 48
1
2 13 24
1
2 2 2 3 24
1
2 3 24
0 , , [0], [0], [0], [0], [0], [0], [0]
, [0], [0], [0], [0], [0], [0], [0],[0]
0 ,[0],[ ], [0], [0], [0],
R R R
G y O y yv R v r
R R
R q s
R I
= −
=
− +
+
1
2 2 3 24
[0], [0], [0]
, [ ], [0], [0], [0], [0], [0], [0],[0]r R I
−
( )
( )
3 2 3
1 2
, 2 , 3 3 2, ,3 48
1
2 13 24
1
2 2 2 3 24
1
2 3 24
0 , , [0], [0], [0], [0], [0], [0], [0]
, [0], [0], [0], [0], [0], [0], [0],[0]
0
R R R
O y O y y O yv R v q s v
R R
R q s
R
= − + +
=
− +
+
( )
1
3 3 2 3 24
3 24
,[0],[ ], [0], [0], [0], [0], [0], [0]
, [ ], [0], [0], [0], [0], [0], [0],[0]
0 ,[0],[0],[ ], [0], [0], [0], [0], [0]
I
q s R I
I
− +
+
( )
3 3
2
, 3 , 3 3,3 48
2 1
3 2 13 24
2 1
3 2 2 2 3 24
2 1
3 2 3 24
0 , , [0], [0], [0], [0], [0], [0], [0]
, [0], [0], [0], [0], [0], [0], [0],[0]
0
R R R
G y O y yv R v r
R R R
R R q s
R R
= −
=
− +
+
( )
2 1
3 3 3 2 3 24
2
3 3 24
2 1 2
3 3 2 3
,[0],[ ], [0], [0], [0], [0], [0], [0]
, [ ], [0], [0], [0], [0], [0], [0],[0]
0 ,[0],[0],[ ], [0], [0], [0], [0], [0]
, , [ ], [0], [0]
I
R q s R I
R I
r R R R I
− +
+
− 3 24, [0], [0], [0],[0]
( )
( )
4 1 4
1
, 1 , 4 4 1, ,3 48
1 3 24
4 4 3 24
3 24
0 ,[ ],[0],[0],[0],[0],[0],[0],[0]
[ ], [0], [0], [0], [0], [0], [0], [0],[0]
0 ,[0],[0],[0],[ ],[0],[0]
R R R
O y O y y O yv R v q s v
R I
q s I
I
= − + +
=
− +
+ ,[0],[0]
( )
4 4
1
, 4 , 4 4,3 48
1
4 1 3 24
1
4 4 4 3 24
1
4 3 24
0 ,[ ],[0],[0],[0],[0],[0],[0],[0]
[ ], [0], [0], [0], [0], [0], [0], [0],[0]
0 ,[0],[0],[0],[ ],[0
R R R
G y O y yv R v r
R R I
R q s I
R I
= −
=
− +
+
1
4 4 3 24
],[0],[0],[0]
, [0], [0], [ ], [0], [0], [0], [0],[0]r R I
−
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 18/20
( )
( )
5 2 5
1 2
, 2 , 5 5 2, ,3 48
1
2 13 24
1
2 2 2 3 24
1
2 3 24
0 , , [0], [0], [0], [0], [0], [0], [0]
, [0], [0], [0], [0], [0], [0], [0],[0]
0
R R R
O y O y y O yv R v q s v
R R
R q s
R
= − + +
=
− +
+
( )
1
5 5 2 3 24
3 24
,[0],[ ], [0], [0], [0], [0], [0], [0]
, [ ], [0], [0], [0], [0], [0], [0],[0]
[0] ,[0],[0],[0],[0],[ ],[0],[0],[0]
I
q s R I
I
− +
+
( )
5 5
2
, 5 , 5 5,3 48
2 1
5 2 13 24
2 1
5 2 2 2 3 24
2 1
5 2 3 24
0 , , [0], [0], [0], [0], [0], [0], [0]
, [0], [0], [0], [0], [0], [0], [0],[0]
0
R R R
G y O y yv R v r
R R R
R R q s
R R
= −
=
− +
+
( )
2 1
5 5 5 2 3 24
2
5 3 24
2 1 2
5 5 2 5
,[0],[ ], [0], [0], [0], [0], [0], [0]
, [ ], [0], [0], [0], [0], [0], [0],[0]
[0] ,[0],[0],[0],[0],[ ],[0],[0],[0]
, , [0], [0], [ ], [
I
R q s R I
R I
r R R R I
− +
+
− 3 240],[0], [0],[0]
( )
( )
6 1 6
1
, 1 , 6 6 1, ,3 48
1 3 24
6 6 3 24
3 24
0 ,[ ],[0],[0],[0],[0],[0],[0],[0]
[ ], [0], [0], [0], [0], [0], [0], [0],[0]
[0] ,[0],[0],[0],[
R R R
O y O y y O yv R v q s v
R I
q s I
= − + +
=
− +
+ 0],[0],[ ],[0],[0]I
( )
6 6
1
, 6 , 6 6,3 48
1
6 1 3 24
1
6 6 6 3 24
1
6 3 24
0 ,[ ],[0],[0],[0],[0],[0],[0],[0]
[ ], [0], [0], [0], [0], [0], [0], [0],[0]
[0] ,[0],[0],[0],
R R R
G y O y yv R v r
R R I
R q s I
R
= −
=
− +
+ 1
6 6 3 24
[0],[0],[ ],[0],[0]
, [0], [0], [0], [0], [ ], [0], [0],[0]
I
r R I −
( )
( )
7 1 7
1
, 1 , 7 7 1, ,3 48
1 3 24
7 7 3 24
3 24
0 ,[ ],[0],[0],[0],[0],[0],[0],[0]
[ ], [0], [0], [0], [0], [0], [0], [0],[0]
[0] ,[0],[0],[0],[
R R R
O y O y y O yv R v q s v
R I
q s I
= − + +
=
− +
+ 0],[0],[0],[ ],[0]I
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 19/20
( )
7 7
1
, 7 , 7 7,3 48
1
7 1 3 24
1
7 7 7 3 24
1
7 3 24
0 ,[ ],[0],[0],[0],[0],[0],[0],[0]
[ ], [0], [0], [0], [0], [0], [0], [0],[0]
[0] ,[0],[0],[0],
R R R
G y O y yv R v r
R R I
R q s I
R
= −
=
− +
+ 1
7 7 3 24
[0],[0],[0],[ ],[0]
, [0], [0], [0], [0], [0], [ ], [0],[0]
I
r R I −
( )
( )
8 7 8
1 7
, 7 , 8 8 7, ,3 48
1
7 1 3 24
1
7 7 7 3 24
1
7
0 ,[ ],[0],[0],[0],[0],[0],[0],[0]
[ ], [0], [0], [0], [0], [0], [0], [0],[0]
R R R
O y O y y O yv R v q s v
R R I
R q s I
R
= − + +
=
− +
+
( )
3 24
1
8 8 7 3 24
3 24
[0] ,[0],[0],[0],[0],[0],[0],[ ],[0]
, [0], [0], [0], [0], [0], [ ], [0],[0]
[0] ,[0],[0],[0],[0],[0],[0],[0],[ ]
I
q s R I
I
− +
+
( )
8 8
7
, 8 , 8 8,3 48
7 1
8 7 1 3 24
7 1
8 7 7 7 3 24
7 1
8 7
0 ,[ ],[0],[0],[0],[0],[0],[0],[0]
[ ], [0], [0], [0], [0], [0], [0], [0],[0]
R R R
G y O y yv R v r
R R R I
R R q s I
R R
= −
=
− +
+
( )
3 24
7 1
8 8 8 7 3 24
7
8 3 24
7 1
8 8 7
[0] ,[0],[0],[0],[0],[0],[0],[ ],[0]
, [0], [0], [0], [0], [0], [ ], [0],[0]
[0] ,[0],[0],[0],[0],[0],[0],[0],[ ]
, [0], [0], [0], [0], [
I
R q s R I
R I
r R R
− +
+
− 7
8 3 240], , [ ],[0]R I
Finally, Eqs. (31) and (32) state the time derivative of the partial velocity of the mass-center of body K can
be written in terms of the time derivative of the partial velocity of the origin of body K, and that the time derivative
of the partial velocity of the origin of body K can be written in terms of the time derivative of the partial velocity
of the origin of its adjacent, lower body.
, , , ,
, , ,
K K K
K K
R J R J R R
G y K O y K O y K K y
TJ R J J R R
K O y K K O y K K y
v R v R v r
R v R v r
= + −
= + −
and
( )
( ) ( ) ( )
, , , ,
,
K J J
TR J R J J R R
O y J O y J J O y K J y
R
K K J y
v R v R v s
q s
= + −
− +
L L L
Kamman – Multibody Dynamics – EOM for Unconstrained Systems – Relative Coordinates – Euler Parameters – page: 20/20
Applying these equations to the example eight-body system gives the following results. All the terms on the right
side of the equations were defined above. Due to the length of the resulting equations, those results were not
substituted into the equations below.
1 , 3 24 3 24[0] ,[0]R
O yv =
1 1 1, 1 , 1 1 , 1 1,
TR R R R R
G y O y O y yv R v R v r = + −
( )2 1 1, 1 , 1 1 , 2 1, 2 2 1,
TR R R R R R
O y O y O y y yv R v R v s q s = + − − +
2 2 2
1 1 1
, 2 , 2 2 , 2 2,
TR R R R
G y O y O y yv R v R v r = + −
( )3 2 2
1 1 1
, 2 , 2 2 , 3 2, 3 3 2,
TR R R R R
O y O y O y y yv R v R v s q s = + − − +
3 3 3
2 2 2
, 3 , 3 3 , 3 3,
TR R R R
G y O y O y yv R v R v r = + −
( )4 1 1, 1 , 1 1 , 4 1, 4 4 1,
TR R R R R R
O y O y O y y yv R v R v s q s = + − − +
4 4 4
1 1 1
, 4 , 4 4 , 4 4,
TR R R R
G y O y O y yv R v R v r = + −
( )5 2 2
1 1 1
, 2 , 2 2 , 5 2, 5 5 2,
TR R R R R
O y O y O y y yv R v R v s q s = + − − +
5 5 5
2 2 2
, 5 , 5 5 , 5 5,
TR R R R
G y O y O y yv R v R v r = + −
( )6 1 1, 1 , 1 1 , 6 1, 6 6 1,
TR R R R R R
O y O y O y y yv R v R v s q s = + − − +
6 6 6
1 1 1
, 6 , 6 6 , 6 6,
TR R R R
G y O y O y yv R v R v r = + −
( )7 1 1, 1 , 1 1 , 7 1, 7 7 1,
TR R R R R R
O y O y O y y yv R v R v s q s = + − − +
7 7 7
1 1 1
, 7 , 7 7 , 7 7,
TR R R R
G y O y O y yv R v R v r = + −
( )8 7 7
1 1 1
, 7 , 7 7 , 8 7, 8 8 7,
TR R R R R
O y O y O y y yv R v R v s q s = + − − +
8 8 8
7 7 7
, 8 , 8 8 , 8 8,
TR R R R
G y O y O y yv R v R v r = + −