Sie sind auf Seite 1von 14

A Brief Synopsis of Kanes Method

This paper is the result of my interest in multi-body dynamics and desire to increase my
knowledge on the topic. My initial intentions were to teach myself Kanes method (originally
called Lagrange form of dAlemberts principle) for developing dynamical equations of motion
and then prepare a lecture for class. As I started learning and applying the technique I realized
that a small lecture would not be sufficient to teach the method and have time to get to some of
the more interesting applications. In this paper I present a proof of Kanes Method using the
Principle of Virtual Work, a general procedure for developing equations of motion, and a few
applications.
Essentially all methods for obtaining equations of motion are equivalent. However, the
ease of use of the various methods differs; some are more suited for multibody dynamics than
others. The Newton-Euler method is comprehensive in that a complete solution for all the forces
and kinematic variables are obtained, but it is inefficient. Applying the Newton-Euler method
requires that force and moment balances be applied for each body taking in consideration every
interactive and constraint force. Therefore, the method is inefficient when only a few of the
systems forces need to be solved for.
Lagranges Equations provides a method for disregarding all interactive and constraint
forces that do not perform work. The major disadvantage of this method is the need to
differentiate scalar energy functions (kinetic and potential energy). This is not much of a
problem for small multibody systems, but becomes an efficiency problem for large multibody
systems.
Kanes method offers the advantages of both the Newton-Euler and Lagrange methods
without the disadvantages. With the use of generalized forces the need for examining interactive
and constraint forces between bodies is eliminated. Since Kanes method does not employ the
use of energy functions, differentiating is not a problem. The differentiating required to compute
velocities and accelerations can obtained through the use of algorithms based on vector products.
Kanes method provides an elegant means to develop the dynamics equations for multibody
systems that lends itself to automated numerical computation. (Huston 1990)

Derivation of Kanes Equations Using the Principle of Virtual Work


Consider an open-chain multibody system of N interconnected rigid bodies each subject
to external and
constraint
forces. The external
forces can be transformed into an equivalent force

and torque ( Fk and M k ) passing through G k , the mass center of the body k (k = 1,2N).

Similar to the external forces, the constraint forces may be written as Fkc and M kc . Using
dAlemberts principle for the force equilibrium
of body k, the following is obtained:

where

Fk m k a k is

Fk Fk Fkc 0

the inertia force of body k.

The concept of virtual work may be described as follows for a system of N particles with
3N degrees of freedom. The systems configuration can be described using qr (r = 1,2,3N)
generalized coordinates with force components F1, F2,, F3N applied to the particles along the
corresponding generalized coordinates. The virtual work is then defined as:
N
W Fi ri
i 1
th

Fi

Where
is the resultant force acting on the i particle and ri is the position vector of the
particle in the inertial reference frame. ri is the virtual displacement, which is imaginary in the
sense that it is assumed to occur without the passage of time.
Now applying the concept of virtual work to our multibody system considering only the
work due to the forces on the system we obtain:

W ( Fk Fk Fkc ) rk 0

(k = 1,2,,N)

The constraints that are commonly encountered are known as workless constraints so

Fkc rk 0

Which simplifies the virtual work equation to:

W ( Fki Fk ) rk 0

or

rk
W ( Fk Fk )
q r 0
q r

(k = 1,2,,N)
(r = 1,2,,3N)

The positions vector may also be written as:

rk rk (q r , t )
2

so

r rk dq r rk
k
q r dt
t

rk

q r
q r

Taking the partial derivative of rk with respect to q r

rk
t

rk
r
k
q r
q r

or

yields

v k
rk

q r
q r

Since the virtual displacement q r is arbitrary without violating the constraints we can write *
as:
f r f r 0

where f r and f r are the generalized active and inertia forces respectively and are defined as
follows:
vk
f r Fk
q r
and
v
f r Fk k
q r
In a similar fashion it can be shown using virtual work that the moments can be written as:
M r M r 0

where M r and M r are the generalized active and inertia moments respectively and are defined
as follows:
k
M r Tk
q r
and

M r ( k I k I k )
q r
By superposition of the force and moment equations we arrive at Kanes equations:
Fr Fr 0

where

Fr f r M r
Fr f r M r

(Adapted from Amirouche 1992)


Notation
Notation that will be used throughout the rest of the paper:
3

q r - generalized coordinate

dq r
u r - generalized speed, typically equal to
dt
N P
velocity
of
P
with
respect
to
the
Newtonian
(inertial) reference frame
v
N A - velocity of the center of mass of body A

Nv A
A
v r - partial velocity, equal to
u r

Cn or Sn Cos(n) or Sin(n)
General Procedure for using Kanes Method
1) Label important points (important points being defined as all center of mass locations, and
locations of applied forces with the exception of conservative constraint forces).
2) Select generalized coordinates (qr) and generalized speeds (ur), then generate expressions for
angular velocity and acceleration of all bodies and velocity and acceleration of the important
points.
3) Construct a partial velocity table of the form:
Generalized
Speeds ( ur )
r=1
r=2
.
.
.

A
vr

.
.
.

B
vr

.
.
.

A
r

.
.
.

B
r

.
.
.

4) Fr + Fr* = 0
where the generalized active force, Fr, is defined as:

A
A
B
B
Fr FA N v r T A N r FB N v r TB N r
r

and the generalized inertia force,Fr*, is defined


as:

N A N A N A

N A N A
N A
Fr m a vr I I r m N a B N vr N B I N B I N B N r
r

5) Which can then be written in the form:

M u RHS (u )
Applications
In this section of the paper I will step through some of the example problems I did to
familiarize myself with Kanes method. I started with simple two-dimensional problems that I
could easily confirm the equations of motion using other methods. As I felt more comfortable

with Kanes method I moved onto 3D problems involving non-holonomic constraints. Presented
here are a few of those problems, which demonstrate the subtleties of Kanes method.
Problem 1
The first problem is a spring-mass-pendulum problem with frictionless sliding. This was
problem is good for showing the general procedure of Kanes method.

q1

Define Transformation Matrix:

n
n

n1

b
q2
1

n2
n3

b1

b2

b3

C2

-S2

S2

C2

Mass of A and P are M1 and M2 respectively


Step 1) Define important points as the center of mass of A and particle P.
Step 2) Select generalized coordinates as shown in the figure and generate velocity and
acceleration expressions for the important points.
N A
N A
v u1n1
a u 1n1
AP
N P
N A
N P
v v r
u1n1 (u 2b3 ) ( Lb2 )

u1n1 u 2 Lb1

a P u 1n1 u 2 Lb1 u 22 Lb2

Step 3) Construct a partial velocity table.


ur

r=1
r=2

vrA
1
n

vrP
1
n

Lb1

Step 4) Fr Fr 0

Fr ( Kq1n1 M 1 gn2 ) N vrA ( M 2 gn 2 ) N vrP


F1 Kq1

Fr ( M 1 N a A ) N vrA ( M 2 gn 2 ) N vrP
F1 M 1u 1 M 2 (u 1 u 2 L cos(q2 ) u22 L sin( q2 ))
5

F2 M 2 Lg sin( q2 )

F2 M 2 (u 1 L cos(q2 ) u 2 L2 )

Step 5) Assemble Fr Fr 0

( M 1 M 2 ) M 2 L cos(q2 )
M L cos(q )
M 2 L2

2
2

u 1 M 2u22 L sin( q2 ) Kq1

u
M 2 Lg sin( q2 )
2

Problem 2
This problem is useful in that it shows how auxiliary generalized speeds can be
introduced to bring constraint forces and torques into evidence. In this case we will introduce u3
to find an expression for Tc (constraint torque about a1 ). The joints at O and P are revolute.
Body A and B are uniform rods with length 4L and 2L respectively. Body A has two times the
mass of body B.
Define the direction cosine matrices:

n
1
a
1
n
n 2
3
n

C1
0
-S1

na
1

a 2

0
O1
0

S1
0
C1

C1

b3

-S1

3
a

a 2

b
1

3
a

AS

b3

01

C1

a3

B
q2

a1

b2
b1

a 2

Step 1) Choose important points: Center of Mass of bodies A and B, and point P.
Step 2) Select generalized coordinates as shown in the figure (plus auxiliary generalized
coordinate u3) and generate velocity and acceleration expressions for the important points.
The prime in the equations below indicates that the specified quantities contain the
auxiliary generalized coordinate.
Body A

A u3 a1 u1a 2


v v r 2L(u3a2 u1a1)

N A N O N A OA
N

A u 1 a 2

a 2Lu1a1 2Lu12 a3

N A

Point P

OP
v v r 4L(u3a 2 u1a1 )

N P N O N A
Body B


(u3a1 u1a 2 ) u2 a3

N B N A A B


v v r L(4u1 u2c2)a1 (4u3 u2s2)a2 (u3c2 u1s2)a3

N B N P N B PB
N

B N A A B N A A B u 1 a 2 u 2 a 3 u1u 2 a1


a a r ( r )

N B N P N B PB N B N B PB

4u 1 a1 u12 a 2 L u 2 c 2 a1 u 2 s 2 a 2 (u1u 2 c 2 u 1 s 2 )a 3 L (u12 s 2 u 22 s 2 )a1 u 22 c 2 a 2 u1u 2 c 2 a 3


Step 3) Construct a partial velocity table.
ur

r=1
r=2
r=3

A
r

a 2

N A
r
2 La1

0
1
a

B
r

a 2

N B
r
4 La1 Ls 2 a 3

a 3

L(c 2 a1 s 2 a 2 )

2 La 2

1
a

L( 4a 2 c 2 a 3 )

Step 4) Fr Fr 0

N A N A N B
Fr (2mgn3) vr (Tca3) r (mgn3) vr
F1 mgL(8s1 s 2 c1 )
F2 mgLs1c 2
F3 mgLc1c 2 Tc

A
A
A

N A N N A A N A A N A N
Fr (2m a ) vr I I r

N B N B N A BB N B BB N B N B
(m a ) vr I I r

4 2
3L

I A 2m

B
I B

1 2
3L
m 0

4 2
L
3
0

0
0
0

4
4
0 L2 a1 a1 L2 a 2 a 2
3
3

0
1
1
0 L2 b1b1 L2 b3 b3
3
3
1 2
L
3
8

8mL2
3

F1

mL2
u 1 ( 8mL2 )u 1
(u 1 s 22 u1u 2 s 2 c 2 )
3

( mL2 ) 4(u 1 u 2 c 2 s 2 (u12 u 2 ) 2 ) s 2 (2u1u 2 c 2 u 1 s 2 )

mL
(u 2 s 2 c 2 u12 ) mL2 (u 1 u 2 c 2 s 2 (u12 u 22 ))c 2 s 2 ( 4u12 u 2 s 2 u 22 )
F2
3
mL2
(u 1 s 2 c 2 2u1u 2 c 22 ) mL2 4(4u12 u 2 s 2 u 22 ) c 2 (2u1u 2 c 2 u 1 s 2 )
F3
3

Step 5) Assemble Fr Fr 0

8mL2
4mL2 2
12mL2
s2
3
3

4mL2 c 2

u 1
mL2

mL2 0 u 2

3
Tc
4mL2 s 2
1

mL2 c 2

mL2
s 2 c 2 mL2 s 2
3

mL2

u1u 2 s 2 c 2 mL2 (4 s 2 (u12 u 2 ) 2 2 s 2 c 2 u1u 2 ) mgl (8s1 s 2 c1 )

3 2

mL 2
2
2
2
2
2
2

u1 s 2 c 2 mL s 2 c 2 (u1 u 2 ) mgls1c 2 mL s 2 (4u1 u 2 )

3
2mL2

u1u 2 c 22 16mL2 u12 mglc 2 c1 2mL2 c 22 u1u 2 16mL2 u 22

Problem 3
This non-holonomic system demonstrates the usefulness of choosing the generalized
speeds to be something other than the first derivative of the generalized coordinates.

n
1
n
n 2
3
n

1
a

a 2

a 3

C1
0
-S1

0
1
0

S1
0
C1

a 2

Define the direction cosine


matrices:

q2

b2

b3

b
1
b

0q

a1
1 a 3

S2

C2

b
3

-C1

S2

q4

1
a

a 2

q5

a 3
1

C
P
~
P C

b1

~
Step 1) Choose important points: Center of Mass of bodies C, point P and P
(on body C).

Step 2) Select generalized coordinates as shown in the figure and generate velocity and
acceleration expressions for the important points.

C N A A B B C

q 1 a 2 q 2 b1 q 3 b3

Case A Choose u i q i (i = 1,2,,5)


Imposing the rolling without slip constraint we obtain:

v P N v C N C ( Rb2 ) 0

[u 4 n3 u5 n1 ( N B Rb2 )] ( N B B C ) ( Rb2 ) 0

u n u n ( B C Rb ) u n u n u Rb 0

5 1

5 1

u 4 n3 u5 n1 u3 Ra3 u 4 n3 u5 n1 u3 R (sin( q1 ) n1 cos(q1 ) n3 ) 0

Which gives us constraint relations on u 4 and u 5


u 4 u3 R cos( q1 )
u5 u3 R sin( q1 )
N

v C u 4 n 3 u 5 n1 ( N B Rb2 )

u 4 n 3 u 5 n1 (u1 a 2 u 2 b1 ) ( Rb2 )
u 4 n3 u5 n1 [u1 (cos(q2 )b2 sin( q2 )b3 ) u 2b1 ] ( Rb2 )

Pluging in the constraint relations allows us to develop the non-holonomic expression for the
velocity of the center of mass of body C:
~

v C u 3 R cos( q1 ) n 3 u 3 R sin( q1 ) n1 u1 R sin(q 2 )b1 u 2 Rb3

u3 Ra3 u1 R sin( q2 )b1 u 2 Rb3


u Rb u R sin( q )b u Rb
3

C N B B C N B B C

{ N A A B N A A B } B C N B B C
{u 1a 2 u 2b1 (u1a 2 ) ( u2b1 )} u 3b3 (u1a 2 u 2b1 ) (u3b3 )
u 1 (c2b2 s2b3 ) u 2b1 u1 (c2b2 s2b3 ) (u 2b1 ) u 3b3 [u1 (c2b2 s2b3 ) u 2b1 ] u3b3
u (c b s b ) u b u u (c b s b ) u b u u c b u u b
1

2 3

2 1

2 3

2 1

3 3

3 2 1

(u 2 u1u 2 s2 u1u3c2 )b1 (u 1c2 u3u 2 )b2 (u 1s2 u1u 2 c2 u 3 )b3

~
~


B
~


d Nv C
d Nv C

N B N v C
dt
dt
R[(u 1 s 2 u1u 2 c 2 u 3 )b1 u 2 b3 ] [u1 (c 2 b2 s 2 b3 ) u 2 b1 ] ( u 3 Rb1 u1 Rs 2 b1 u 2 Rb3 )
R[(u 1s2 u1u 2 c2 u 3 )b1 u 2b3 ] u1u3 Rc2b3 u12 Rc2 s2b3 u1u 2 Rc2b1 u1u3 s2 Rb2 u12 s22 Rb2 u32 Rb2 u1u3 Rs2b2
N

~

aC

Step 3) Construct a partial velocity table.


ur

rC

~
vrC
10

r=1

c 2 b2 s 2 b3

Rs 2 b1

r=2

b1

Rb3

r=3

Rb1

Step 4) Fr Fr 0

~
~
Fr mc g (c2 b2 s 2 b3 ) N vrC

~
F1 0

~
F2 mc Rgs 2
~
F3 0

~ C C N C C C N C N C N ~C N ~C
Fr {I I } r (mC a ) vr

~
Fr I 11b1b1 I 22 b2 b2 I 33b3b3 (u 2 u1u 2 s 2 u1u 3 c 2 )b1 (u 1c 2 u 3u 2 )b2 (u 1 s 2 u1u 2 c 2 u 3 )b3 N rC

~
mc R[(u 1 s 2 u1u 2 c2 u 3 )b1 u 2 b3 ] u1u 3 Rc 2 b3 u12 Rc 2 s 2 b3 u1u 2 Rc2 b1 u12 s 22 Rb2 u 32 Rb2 u 22 Rb2 N vrC
~
F1 I 22 c 2 (u 1 c 2 u 3 u 2 ) I 33 s 2 (u 1 s 2 u1u 2 c 2 u 3 ) mc R 2 s 2 (u 1 s 2 2u1u 2 c 2 u 3 )
~
F2 I 11 (u 2 u1u 2 s 2 u1u 3 c 2 ) m c R 2 (u 2 u1u 3 c 2 u12 c 2 s 2 )
~
F3 I 33 (u 1 s 2 u1u 2 c 2 u 3 ) m c R 2 (u 1 s 2 2u1u 2 c 2 u 3 )

Step 5) Assemble Fr Fr 0

I 22 c 22 I 33 s 22 mc R 2 s 22

0
I 33 s 2 mc R 2 s 2

I 11 mc R 2
0

I 33 s 2 mc R 2 s 2

0

2
I 33 mc R

u 1 I 22 c 2 u 2 u 3 I 33 s 2 c 2 u1u 2 2mc R 2 s 2 c 2 u1u 2

u 2 I 11 s 2 u1u 2 I 11 c 2 u1u 3 mc ( R 2 c 2 u1u 3 Rgs 2 )

u 3
I 33 c 2 u1u 2 2mc R 2 c 2 u1u 3

Notice that the inertia matrix, M, is not symmetric. However if the definitions of the generalized
speeds are choosen wisely then it is possible to produce a inertia matrix that is symmetric
positive definite.

Case B - Choose u1, u2, u3 such that N C u1b1 u 2 b2 u 3b3


N

C q 1 a 2 q 2 b1 q 3 b3
q 1 (c 2 b2 s 2 b3 ) q 2 b1 q 3 b3 ( q 2 )b1 (q 1c 2 )b2 ( q 1 s 2 q 3 )b3

From which we can derive the expressions for u1, u2, u3:
u1 q 2
u 2 q 1c 2

11

u 3 q 1 s 2 q 3
N

v C N v B N C Rb2 0 (u1b1 u 2 b2 u 3 b3 ) Rb2 R ( u 3 b1 u1b3 )

C u 1b1 u 2b2 u 3b3

~
a R (u 3 u1u2 )b1 (u1 u3u2 )b3 (u12 u32 )b2

N C

Step 3) Construct a partial velocity table.


ur

rC

~
vrC

Rb3

r=2

b1
b

r=3

b3

Rb1

r=1

Step 4) Fr Fr 0

~
N C
2
2 N~

Fr I11u1b1 I 22 u 2b2 I 33u3b3 r mc R (u3 u1u 2 )b1 (u1 u3u 2 )b3 (u1 u3 )b2 vrC
~
F1 I 11u 1 mc R 2 (u 1 u 3 u 2 )
~
F2 I 22 u 2
~
F3 I 33 u 3 mc R 2 (u 3 u1u 2 )

~
~
Fr mc g (c2 b2 s 2 b3 ) N vrC
~
F1 mc Rgs 2

~
F2 0

~
F3 0

Step 5) Assemble Fr Fr 0

I 11 mc R 2

0
I 22
0

2
I 33 mc R

2
2
u 1 mc R u 3 u 2 mc R gs 2

u
0

2
2

u 3
mc R u1u 2

The inertia matrix is now symmetric positive definite.


Conclusions
Although the applications of Kanes method to multibody systems in this paper has been
light, I have shown that is a powerful technique. It offers the advantages of both the NewtonEuler and Lagrange methods in that it can be comprehensive and efficient.
12

As part of learning Kanes method I have taught myself how to use Autolev, a dynamics
software package that uses Kanes method to develop equations of motion and perform
simulations. In the future I plan on using Autolev to develop equations of motion for a biped.
So far I have successfully built simple models of a biped in the frontal plane to compare to
published works. The next step is to develop a simple three dimensional model and slowly
increase its complexity by adding joints/additional degrees of freedom.

13

References
Amirouche, Farid M.L. Computational Methods in Multibody Dynamics. New Jersey: Prentice
Hall, 1992.
Anderson, Kurt S. Lecture Notes from Applied Multibody Dynamics. Rensselaer Polytechnic
Institute 1998.
Critchley, James H. Personal Interviews. February-May 1999.
Critchley, James H. Personal Notes: Kane's Method Application. March 1999.
Huston, Ronald L. Multibody Dynamics. Boston: Butterworth-Heinemann, 1990.
Kane, Thomas R., and David A. Levinson. Dynamics: Theory and Applications. New York:
McGraw-Hill, 1985.

14

Das könnte Ihnen auch gefallen