Professional Documents
Culture Documents
Chapter 6
Introduction
Solution
Solve a set of differential equations
Dynamic Equations - Newton-Euler method
or Lagrangian Dynamics
τ M ( )
V ( ,
) G ( ) F ( ,
)
Inverse Dynamics
Problem
Given: Angular acceleration, velocity and
angels of the links in addition to
the links geometry, mass, inertia,
friction
Solution
Solve a set of algebraic equations
Dynamic Equations - Newton-Euler
method or Lagrangian Dynamics
τ M ( )
V ( ,
) G ( ) F ( ,
)
Two Approaches
Energy based: Lagrange-Euler.
F mv c
Dynamics - Newton-Euler Equations
Eular Equation
For a rotating rigid body, the moment
that causes an angular acceleration is
given by Euler’s equation
d c I
N
dt
For our robot manipulators, whose link
moment of inertia is constant, this
equation simplifies to
N cI c I
The second term on the right will be
non-zero when the link’s angular
velocity vector is not coincident with the
link’s principle axis of inertia.
Dynamics - Newton-Euler Equations
To solve the Newton and Euler equations, we’ll need to develop
mathematical terms for:
F mv c
N I I
c c
Chapter 5
Linear and Rotational Velocity A
B
• Vector Form B
PQ
A
VQ VBORG R VQ B R PQ
A A
B
B A A
B
B
• Matrix Form
A
VQ AVBORG BAR BVQ BAR BA R BPQ
Angular Velocity
A
C A B BAR B C
• Vector Form
• Matrix Form
A
C R BAR BAR CBR BA R T
11
Acceleration of a rigid body
Linear and angular accelerations:
dB VQ (t t ) BVQ (t )
B
B
VQ VQ lim
,
dt t 0 t
dA A
B (t t ) B (t )
A
B
A
B lim .
dt t 0 t
Linear acceleration
A
VQ BAR BVQ A B BA R BQ. : origins are coincident.
d A B
( B R Q) BAR BVQ A B BA R BQ. : re-write it
dt
as.
d A B d A B
A
VQ ( B R VQ ) B B R Q B ( B R Q ) : by differentiating.
A A B A
dt dt
BAR BVQ A B BA R BVQ A
A R BQ A ( AR BV A A R BQ )
B B B B Q B B
A B ( A B BA R BQ).
VQ BVQ 0.
B : when B
Q is constant
A
C B R C .
A A
B
B
A d A R B .
A
C B B C
dt
A AR B
B B
A AR B .
C B B C
F mv c
N I I
c c
Propagation of Acceleration – Angular
Matrix Approach
B is rotation relative to A and C is rotating relative to B
C B B R C B B R C ,
A A A B A A B
A 0, B i, C i 1
i 1 i i R i 1 i i R i 1
0 0 0 i 0 0 i
i 1
Multiply by 0 R
i 1 i 1 i 1 0 i i 1
0 R
0
i 1 0 R i 0 R i R i 1 0 R ( i i R i 1 )
0 0 0 i
i 1
i 1 i 1 i i 1Ri i
i 1R 0 i 1R 0 R i
i 1 0 i 0 i i 1
0 0
i 1
i 1 i
i 1 i
i 1 i R i 0 i R i 0
i 1 i 1
Propagation of Acceleration – Angular
Matrix Approach
To derive a general formula for the angular acceleration, we will
differentiate the angular velocity
i 1 R i 0 0 i 1
i 1 i 1
i
i T
Applying the chain rule, we find:
i 1 R i R i 0 0 i 1
i 1 i 1
i
i
i i 1
i
T
Recall that
0 z y
A
B R
d A
dt
B R
z 0
x BA R BAR BA R
y x 0
Propagation of Acceleration – Angular
Matrix Approach
Matrix form (Revolute Joint) i 1 i R i i R i R i 0 0 i 1
i 1
i 1 i
i 1 i 1 i T
Converting from matrix to vector form gives the angular acceleration
vector
0 0
Vector form (Revolute Joint)
i 1
i 1 i i1R i i i i1R i i 0 0
i 1 i 1
If joint i+1 is prismatic, the angular terms are zero ( i 1 i 1 0 ) and
the above equation simplifies to:
F mv c
N I I
c c
Propagation of Acceleration - Linear
Simultaneous Linear and Rotational Velocity
Vector Form
Matrix Form
i 1 i i i 1 i i
Re-assigning the link frames ( 0V 0R 0 R iP 0V 0R iV
i 1 ), we find
i 1
Pre-multiplying both sides of the equation by 0 R gives:
i 1
0 R 0Vi 1 i 01R 0i R
0 R iP i 1R 0R 0 R 0 R iP i 1R 0V 2i 1R 0R 0 R iV i 1R 0R iV
i i 1 0 i i i i 1 0 i 0 i i i 1 0 i i 1
i 1
0 R 0Vi 1 i i1R 0iR 0i R
0 R iP i 1R iR 0R 0 R 0 R iP i 1R 0V 2i 1R iR 0R 0 R iV i 1R 0R iV
i i 1 i 0 i i i i 1 0 i i 0 i i i 1 0 i i 1
Propagation of Acceleration - Linear
i 1
0 R 0Vi 1 i i1R 0iR 0i R 0i R iPi 1 i i1R 0iR 0i R 0i R 0i R iPi 1 i 01R 0Vi 2i i1R 0iR 0i R 0i R iVi 1 i 01R 0i R iVi 1
s T s 0A
Simplifying the previous equation using (Note: R R t R t R B
s A
t B )
R R R i R 0R
i 0 0 i R i
i R T i R 0
0 i i 0 i 0 0 i 0 i i
0
i
R 0i R 0i R 0i R i i i i
i 1
0 R 0Vi i i1R 0iR 0Vi i i1R i v i
0
i
R 0i R 0i R 0i R 0i i i
we have
i 1
v i 1 i i1R i i i Pi 1 i i i i i Pi 1 i v i 2i i i 1 vi 1 i 1v i 1
Propagation of Acceleration - Linear
i 1
v i 1 i i1R i i i Pi 1 i i i i i Pi 1 i v i 2i 1i 1 i 1 vi 1 i 1v i 1
This equation can be written equivalently as:
0 0
General form i 1v i 1 i i1R i i i Pi 1 i i i i i Pi 1 i v i 2i 1 i 1 0 0
d i 1 di 1
If joint i+1 is revolute joint, the linear terms are zero and the
above equation simplifies to:
Revolute Joint i 1
v i 1 i i1R i i i Pi 1 i i i i i Pi 1 i v i
Propagation of Acceleration - Linear
From the general equation, we can also get the solution for the
acceleration of the center of mass for link i. Appropriate frame
substitution and elimination of prismatic terms gives we find:
i
v ci i i i Pc i i i i i i Pc i i v i
Frame {Ci} attached to each link with its origin located at the Center
of mass of the link, and with the same orientation as the link frame
{i}