Chapter 4

Dynamic Analysis and Forces

4.1 INTRODUCTION
In this chapters…….
 The dynamics, related with accelerations, loads, masses and
__ __ __ __
inertias.
 F  m a  T  I 

Fig. 4.1 Force-mass-acceleration and torque-inertia-angular

acceleration relationships for a rigid body.

In Actuators…….
 The actuator can be accelerate a robot’s links for exerting enough forces
and torques at a desired acceleration and velocity.
 By the dynamic relationships that govern the motions of the robot,
considering the external loads, the designer can calculate the necessary
forces and torques.
 Chapter 4
Dynamic Analysis and Forces
4.2 LAGRANGIAN MECHANICS: A SHORT OVERVIEW
 Lagrangian mechanics is based on the differentiation energy terms
only, with respect to the system’s variables and time.
 Definition: L = Lagrangian, K = Kinetic Energy of the system, P = Potential
Energy, F = the summation of all external forces for a linear
motion, T = the summation of all torques in a rotational motion,
x = System variables

L K P
  L  L
Fi  
  
t   xi  xi

  L  L
Ti  
  
t    i   i
Chapter 4
Dynamic Analysis and Forces
Example 4.1 Derive the force-acceleration relationship for the one-degree of freedom system.

Fig. 4.2 Schematic of a simple cart-spring system. Fig. 4.3 Free-body diagram for the sprint-cart system.

1 2 1 2 1 1 2 1 2
Solution K  mv  m x , P  kx 2 L  K  P  m x  kx
2 2 2 2 2
 Lagrangian mechanics  Newtonian mechanics
__ __
L
 F  m a
d .. .. L
 m x, ( m x )  m x,  kx
.
 xi dt x
.. F  kx  ma  F  ma  kx
F  m x  kx
 The complexity of the terms increases as the number of degrees of freedom
and variables.
Chapter 4
Dynamic Analysis and Forces
Example 4.2 Derive the equations of motion for the two-degree of freedom system.

In this system…….
 It requires two coordinates, x and .
 It requires two equations of motion:
1. The linear motion of the system.
2. The rotation of the pendulum.

Fig. 4.4 Schematic of a cart-pendulum

system.

Solution

 F   m1  m2 m2l cos   x  0 m2l sin    x 2  

.. .
kx 
T   m l cos m l 2   ..   0  
 . 2  m gl sin  
   2 2     0     2 
Chapter 4
Dynamic Analysis and Forces
Example 4.4 Using the Lagrangian method, derive the equations of motion for the two-degree
of freedom robot arm.

Solution
Follow the same steps as before…….
 Calculates the velocity of the center of
mass of link 2 by differentiating its
position:
 The kinetic energy of the total system is the

sum of the kinetic energies of links 1 and 2.

 The potential energy of the system is the
sum of the potential energies of the two
Fig. 4.6 A two-degree-of-freedom robot arm. links:
 Chapter 4
Dynamic Analysis and Forces
4.3 EFFECTIVE MOMENTS OF INERTIA

 To Simplify the equation of motion, Equations can be rewritten in

symbolic form.

 ..
T1   Dii Dij   i   .
 Diii Dijj  1 2   Diii Dijj  1  2   Di 
 . .

T    D D   ..    D D   . 2    D D   . .    D 
 2   ji jj   j   jii jjj   2   jii jjj   2 1   j 
 Chapter 4
Dynamic Analysis and Forces
4.4 DYNAMIC EQUATIONS FOR MULTIPLE-DEGREE-OF-FREEDOM ROBOTS
4.4.1 Kinetic Energy
 Equations for a multiple-degree-of-freedom robot are very long and
complicated, but can be found by calculating the kinetic and potential
energies of the links and the joints, by defining the Lagrangian and by
differentiating the Lagrangian equation with respect to the joint variables.

 The kinetic energy of a rigid body

with motion in three dimension :
1 2 1 __
K  mV   h G
2 2
 The kinetic energy of a rigid body
in planar motion
1 2 1
K mV  I 2
2 2
Fig. 4.7 A rigid body in three-dimensional motion and
in plane motion.
 Chapter 4
Dynamic Analysis and Forces
4.4 DYNAMIC EQUATIONS FOR MULTIPLE-DEGREE-OF-FREEDOM ROBOTS
4.4.1 Kinetic Energy
 The velocity of a point along a robot’s link can be defined by differentiating
the position equation of the point.

pi  RTi ri  0Ti ri
 The velocity of a point along a robot’s link can be defined by differentiating
the position equation of the point.

1 n i i
 
1 n
K i   Trace U ip J iU ir q p q r   I i ( act ) q i2
2 i 1 p 1 r 1
T

2 i 1
 Chapter 4
Dynamic Analysis and Forces
4.4 DYNAMIC EQUATIONS FOR MULTIPLE-DEGREE-OF-FREEDOM ROBOTS
4.4.2 Potential Energy
 The potential energy of the system is the sum of the potential energies of each link.

n n
P   pi   [ mi g T ( 0Ti ri )]
i 1 i 1

 The potential energy must be a scalar quantity and the values in the gravity

matrix are dependent on the orientation of the reference frame.

 Chapter 4
Dynamic Analysis and Forces
4.4 DYNAMIC EQUATIONS FOR MULTIPLE-DEGREE-OF-FREEDOM ROBOTS
4.4.3 The Lagrangian

1 n i i
 
L  K  P   Trace U ip J iU irT q p q r
2 i 1 p 1 r 1
1 n n
  I i ( act ) q i   [ mi g T ( 0Ti ri )]
2

2 i 1 i 1
 Chapter 4
Dynamic Analysis and Forces
4.4 DYNAMIC EQUATIONS FOR MULTIPLE-DEGREE-OF-FREEDOM ROBOTS
4.4.4 Robot’s Equations of Motion
 The Lagrangian is differentiated to form the dynamic equations of motion.
 The final equations of motion for a general multi-axis robot is below.
n n n
Ti   Dij q j I i ( act ) qi   Dijk q j q k Di
j 1 j 1 k 1

n
where, Dij   Trace (U
p  max(i , j )
pj J pU Tpi )
n
Dijk   Trace (U
p  max( i , j , k )
pjk J pU Tpi )

n
Di    m p g T U pi rp
p i
Chapter 4
Dynamic Analysis and Forces
Example 4.7 Using the aforementioned equations, derive the equations of motion for the two-
degree of freedom robot arm. The two links are assumed to be of equal length.

Follow the same steps as before…….

 Write the A matrices for the two links;
 Develop the Dij , Dijk and Di for the robot.

Fig. 4.8 The two-degree-of-freedom robot arm of Example 4.4

Solution  The final equations of motion without the actuator inertia terms are the same as
below.
1 4  1 1 
T1   m1l 2  m2l 2  m2l 2C2 1   m2l 2  m2l 2C2 2
3 3  3 2 
1 
  1 1
  m2l 2 S 2 22  m2l 2 S 2 12  m1 glC1  m2 glC12  m2 glC1  I1( act )1
2  2 2

1 1  1  1  1
T2   m2l 2  m2l 2C2 1   m2l 2 2   m2l 2 S 2   m2 glC12  I 2 ( act )1
3 2  3  2  2
Chapter 4
Dynamic Analysis and Forces
4.5 STATIC FORCE ANALYSIS OF ROBOTS
 Robot Control means Position Control and Force Control.

 Position Control: The robot follows a prescribed path without any reactive force.

 Force Control: The robot encounters with unknown surfaces and manages to
handle the task by adjusting the uniform depth while getting the reactive force.

Ex) Tapping a Hole - move the joints and rotate them at particular rates to
create the desired forces and moments at the hand frame.

Ex) Peg Insertion – avoid the jamming while guiding the peg into the hole and
inserting it to the desired depth.
Chapter 4
Dynamic Analysis and Forces
4.5 STATIC FORCE ANALYSIS OF ROBOTS
 To Relate the joint forces and torques to forces and moments generated at the
hand frame of the robot.
T  f is the force and m is the moment
 H F    H f x H
fy H
fz H
mx H
my H
mz  along the axes of the hand frame.

W   F   D  T  D 
T H T
 The total virtual work at the joints
H
 must be the same as the total work
at the hand frame.
 dx 
 dy 
 
 dz 
 W   f x fy fz mx my mz     f x dx    mz  z
 x 
 y 
 
 z 
T   H J T H F   Referring to Appendix A
Chapter 4
Dynamic Analysis and Forces
4.6 TRANSFORMATION OF FORCES AND MOMENTS BETWEEN COORDINATE FRAMES

 An equivalent force and moment with respect to the other coordinate frame
by the principle of virtual work.

F T   f x f y f z mx m y mz   F   f
B T B
x
B
fy B
fz B
mx B
my B
mz 
D T  d x dy dz  x  y  z   D   d
B T B
x
B
dy B
dz x
B B
y B
z 
 The total virtual work performed on the object in either frame must be the same.

W  F  D    T   D
T B T B
Chapter 4
Dynamic Analysis and Forces
4.6 TRANSFORMATION OF FORCES AND MOMENTS BETWEEN COORDINATE FRAMES

 Displacements relative to the two frames are related to each other by the
following relationship.
 D   J D
B B

 The forces and moments with respect to frame B is can be calculated directly
from the following equations:

B
fx  n  f
B
m x  n  [ f  p   m ]
fy  o  f m y  o  [ f  p   m ]
B B

fy  o  f m z  a  [ f  p   m ]
B B