Professional Documents
Culture Documents
Newtonian Approach
Berke Gür
Robotics 5/17/2021
Berke Gür 1
Objectives
• Given the trajectory of (q, dq/dt, d2q/dt2), compute the joint
forces/torques that need to be applied by the actuators
• Given the joint forces/torques (Γ), compute the trajectory of
the manipulator links
Robotics 5/17/2021
Berke Gür 2
Dynamic Analysis of Manipulators
• Links are assumed to be rigid bodies
• We will first solve manipulator dynamics using the classical
Newtonian approach (vector based)
• The dynamics of the manipulator is investigated link-by-link
• Next lecture, we will solve the same problem using the
alternative Lagrangian approach (scalar energy based)
• In the Lagrangian approach, the manipulator is treated as a
whole in the dynamic analysis
Robotics 5/17/2021
Berke Gür 3
Linear Acceleration
• Linear acceleration is the rate of change in the linear velocity
d 2 V p (t + ∆t ) − V p (t )
2 2
=
Vp =
2
V p lim
dt ∆t →0
∆t
Universal reference
frame {U}
U
V2 = v2
Robotics 5/17/2021
Berke Gür 4
Angular Acceleration
• Angular acceleration is the rate of change in the angular
velocity
1 d 1 Ω 2 (t + ∆t ) − Ω 2 (t )
1 1
Ω 2= Ω 2= lim
dt ∆t →0
∆ t
Universal reference
frame {U}
U
Ω 2 =ω 2
Robotics 5/17/2021
Berke Gür 5
Linear Acceleration with Frame Change
• Taking the time derivative of the linear velocity of point p
1 2 1
1 1 2 ⋅ p+ V
Vp = 2 R ⋅ Vp + 2 R o2
we get
1 2
V p=
1 1
2 R ⋅ V p + 2 ⋅ Ω 2 × ( 2 R ⋅ V p ) + Ω 2 × ( 2 R ⋅ p )...
2 1 1 2 1
2
1
... + Ω 2 × [ Ω 2 × ( 2 R ⋅ p )] + Vo2
1 1 1
Robotics 5/17/2021
Berke Gür 6
Linear Acceleration with Frame Change
• Assuming that 1Vo2 = 0, we get
1 2
V p=
1 1
2 R ⋅ V p + 2 ⋅ Ω 2 × ( 2 R ⋅ V p ) + Ω 2 × ( 2 R ⋅ p )...
2 1 1 2 1
... + Ω 2 × [ Ω 2 × ( 21 R ⋅ 2 p )]
1 1
Robotics 5/17/2021
Berke Gür 7
Angular Acceleration with Frame Change
• Assume that {2} is rotating with respect to {1} with a velocity
of 1Ω2 and {3} is rotating with respect to {2} with a angular
velocity 2Ω3. Then we have
1
Ω3 = Ω 2 + 2 R ⋅ Ω3
1 1 2
1
2
1
Ω3 = Ω 2 + 2 R ⋅ Ω3 + Ω 2 × ( 2 R ⋅ Ω3 )
1 1 1 2
Robotics 5/17/2021
Berke Gür 8
The Iterative Newton-Euler Method
• For the given joint variables (q, dq/dt, d2q/dt2), we
compute the joint torques (iΓi) that need to be applied
by the actuators using an iterative approach
• Links are assumed to be rigid bodies
• The iterative Newton-Euler method consists of two loops
– The outward iterations
In the outward iterations, we compute the net effective (inertial
forces) acting on each link by computing the linear and angular
accelerations of the COM of each link. We start from link 0 and
proceed outwards to link N
– The inward iterations
In the inward iterations, we compute the torques required
(exerted by the actuators) to satisfy the dynamic force-torque
balance. We start from link N and proceed towards link 1
Robotics 5/17/2021
Berke Gür 9
The Outward Iterations
Robotics 5/17/2021
Berke Gür 10
The Outward Iterations
• From velocity kinematics for a (R) joint we have
ωi +1 =
i +1 i +1
i R ⋅ ωi + [0 0 θi +1 ]T
i
i +1
ω i +1 = i +1
i R ⋅ iω i + i +1i R ⋅ iωi × [0 0 θi +1 ]T + [0 0 θi +1 ]T
= =
ω
i +1
i +1
i +1
=Ri⋅ ω i
i
, (θ i +1 θ i +1 0)
Robotics 5/17/2021
Berke Gür 11
The Outward Iterations
• Also from velocity kinematics
i +1
vi +1 = i +1
i R ⋅ i vi + i +1i R ⋅ ( iωi × i oi +1 ), (R) joint
i +1
vi +1 = i +1
i R ⋅ i vi + i +1i R ⋅ ( iωi × i oi +1 ) + [0 0 di +1 ]T , (P) joint
• Note that
c θi +1 s θi +1 0 ai c θi +1 ai
i − c α sθ
i +1
R ⋅ o = c α i c θi +1 s α i ⋅ ai s θi +1 =
d sin α
i i +1 i i +1 i +1 i
s α i s θi +1 − s α i c θi +1 c α i di +1 di +1 cos α i
Robotics 5/17/2021
Berke Gür 12
The Outward Iterations
• Using the expression for linear acceleration we obtained in
slide 5, we get
vi +1
i +1
= i +1
i R[ iω i × i oi +1 + iωi × ( iωi × i oi +1 ) + i vi ] , (R) joint
i i i i i
i +1
=
vi +1 R[ ωi × oi +1 + ωi × ( ωi × oi +1 ) + vi ]...
i +1
i
i
i +1
... + 2 ωi +1 × [0 0 di +1 ]T + [0 0 di +1 ]T , (P) joint
Robotics 5/17/2021
Berke Gür 13
The Outward Iterations
– The angular motion of the link about its COM is governed by the
moment balance equation (Euler’s equation)
c ,i
∑ M=i c ,i
I iωi + ωi × I iωi Angular velocity expressed in
the frame attached to link
i +1
i +1
Fc ,i +1 = mi +1 vc ,i +1
i +1 i +1 i +1
i +1
M c ,i +1 = c ,i +1
I ⋅ ωi +1 + ωi +1 × c ,i +1
I ⋅ ωi +1
i
i
Fc ,i
i
M i +1 = i
i +1 R i +1M i +1
Mi
i
M c ,i
LINK i
i
Fi
i
Fi +1 = i
i +1 R i +1Fi +1
Robotics 5/17/2021
Berke Gür 16
The Inward Iterations
• Derive the EoM for the (RR) planar manipulator shown below
using the iterative Newton-Euler method (assume that the
masses of the links are concentrated at the tip point of each
link)
m2
l2
( R)
l1 m1
( R)
Robotics 5/17/2021
Berke Gür 18
Equations of Motion of a Manipulator
• The equations of motion of a manipulator can be expressed in
a general matrix form as
Γ = M (q)q
+ c(q, q ) + g (q)
where
– M is the mass matrix
– c is the vector containing the centrifugal (contains square of joint
velocities) and Coriolis (products of joint velocities) terms
– g is the vector of the gravity terms
• The mass matrix (M) is a symmetric positive definite matrix
(i.e., qTMq > 0 or the eigenvalues of M are always positive)
Robotics 5/17/2021
Berke Gür 19
Next Lecture
• Lecture topics
– Path Planning & Trajectory Generation
• Reading assignment: Ch. 7 in textbook
• Questions?
Robotics 5/17/2021
Berke Gür 21
Supplemental Notes:
Mass Moment of Inertia
Berke Gür
Robotics 5/17/2021
Berke Gür 22
Inertia
• Tangential force
θ = ω
θ
F=
t rω ⋅ dm m
θ = ω
O r
• Moment of force Ft about point O is dm
a=
t rω θ v
r=
=
v2
= rθ= vθ
M= ω ⋅ dm Ft = rω dm a= 2
2
O r n
r
∫ ⋅ dm ω ∫ r=
r 2ω = ∫ r 2 dV
dm ωρ
2
m m V
Robotics 17.05.2021
Berke Gür 23
Inertia Tensor
I xx − I xy − I xz
A
I=
− I xy I yy − I yz { A} Zˆ A
− I xz − I yz I zz
dV
A
P
YˆA
Xˆ A
Robotics 17.05.2021
Berke Gür 24
Inertia Tensor
• Ixx, Iyy, and Izz are termed the mass moments of inertia
• Mass moments of inertia are (+) valued
I xx = ∫∫∫ ( y + z 2 ) dm = ∫∫∫
2
rx2 dm
V V
I yy = ∫∫∫ ( x + z 2 ) dm = ∫∫∫
2
ry2 dm
V V
I zz = ∫∫∫ ( x + y 2 ) dm = ∫∫∫
2
rz2 dm
V V
• Ixy, Iyz, and Ixz are termed the mass products of inertia
• Mass products of inertia can be (+) or (–) valued
=I xy ∫∫∫
=
V
xydm, I
xz∫∫∫
= xzdm, I
V ∫∫∫ yz V
yzdm
Robotics 17.05.2021
Berke Gür 25
Example: Inertia
• You are free to choose the geometry of the inifinitesimal mass
dm
Choose geometry that simplifies the problem
Find the inertia of the cylinder about axis OOʹ
Robotics 17.05.2021
Berke Gür 26
Mass Moments of Inertia of Common Link Structures
Robotics 5/17/2021
Berke Gür 27
Mass Moments of Inertia of Common Link Structures
Robotics 5/17/2021
Berke Gür 28
Mass Moments of Inertia of Common Link Structures
Robotics 5/17/2021
Berke Gür 29
Parallel Axis Theorem
• The parallel axis theorem is a simple method to compute the
entries of the inertia tensor for a frame {A} with the same
orientation as frame {C}
0
I xx =C I xx + m( yc2 + zc2 ),
0
I yy =C I yy + m( xc2 + zc2 ),
0
I zz =C I zz + m( xc2 + yc2 )
Robotics 5/17/2021
Berke Gür 30
Properties of the Inertia Tensor
1. If two axes of a frame form a Zˆ C