Lecture_Notes_W6
Lecture_Notes_W6
Ashitava Ghosal
NPTEL, 2020
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 1 / 103
1 C ONTENTS
2 L ECTURE 1
Introduction
Linear and Angular Velocity of Links
3 L ECTURE 2
Serial Manipulator Jacobian Matrix
4 L ECTURE 3
Parallel Manipulator Jacobian Matrix
5 L ECTURE 4
Singularities in Serial and Parallel Manipulators
6 L ECTURE 5
Statics of Serial and Parallel Manipulators
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 2 / 103
O UTLINE
1 C ONTENTS
2 L ECTURE 1
Introduction
Linear and Angular Velocity of Links
3 L ECTURE 2
Serial Manipulator Jacobian Matrix
4 L ECTURE 3
Parallel Manipulator Jacobian Matrix
5 L ECTURE 4
Singularities in Serial and Parallel Manipulators
6 L ECTURE 5
Statics of Serial and Parallel Manipulators
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 3 / 103
I NTRODUCTION
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 4 / 103
O UTLINE
1 C ONTENTS
2 L ECTURE 1
Introduction
Linear and Angular Velocity of Links
3 L ECTURE 2
Serial Manipulator Jacobian Matrix
4 L ECTURE 3
Parallel Manipulator Jacobian Matrix
5 L ECTURE 4
Singularities in Serial and Parallel Manipulators
6 L ECTURE 5
Statics of Serial and Parallel Manipulators
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 5 / 103
L INEAR V ELOCITY OF R IGID B ODY
The linear velocity of Oi with respect to {0} is defined as
d 0 0 O (t + ∆t) −0 O (t)
0 ∆ i i
VOi = Oi (t) = lim (1)
dt
Rigid body at
∆t→0 ∆t
t + ∆t
Ẑ
{0} ‘0’ denote the coordinate system {0}
{i}(t)
{i}(t + ∆t)
where the limit is taken.
0
Oi (t)
Oi The linear velocity vector can be
described in {j} as
Oi ( )
Ŷ
j 0
VOi = j0 [R]0 VOi (2)
0
Oi (t + ∆t) Two different coordinate system
X̂
involved: where differentiation done,
Rigid body at t
and where described!
F IGURE : Linear velocity of a rigid body . . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 6 / 103
A NGULAR V ELOCITY OF R IGID
B ODY
Angular velocity cannot be obtained as a time derivative of 3 quantities (say 3
Euler angles) representing orientation.
Angular velocity from time derivative of rotation matrix.
Recall
T
0
i [R] 0i [R] = [U], [U] is a 3 × 3 identity matrix
Differentiate with respect to time t
˙ 0 [R]T
0 [R] ˙ T = [0]
+ 0i [R] 0i [R]
i i
Note: derivative of a matrix implies derivative of all components of the matrix.
Above equation can be written as
˙ 0 [R]T
0 [R] ˙ 0 [R]T )T = [0]
+ (0i [R]
i i i
Obtain A ˙ A T
B [R] B [R]
The X , Y and Z components of the angular velocity vector
0 [Ω] T
i R — Derived from right multiplication 0i [R] 0i [R] = [U].
Derived 0 ω si called the space-fixed angular velocity — Superscript s.
0 [R]T 0 [R] = [U] → Another skew-symmetric matrix
i i
0 −ωzb ωyb
0 ∆0 T ˙ = ωb
0 [R] 0 −ωxb (7)
i [Ω]L = i [R] i z
−ωyb ωxb 0
0 [Ω] T 0
i L derived from left multiplication 0i [R] i [R] = [U]
Angular velocity vector 0ω b from the three components (ωxb , ωyb , ωzb ).
i
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 10 / 103
A NGULAR V ELOCITY – C ONTD .
For the Z-Y-Z rotation the three components are
0
Vp = ˙ 0 [R]T 0 p
0 [R]
i i
i [Ω]R p = ω i ×0 p
0 0 0 s
= (11)
The coordinate system {i} does not appear except in denoting that rigid body
{i} is being considered.
Space-fixed angular velocity vector is said to be independent of the choice of
the body coordinate system. . . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 13 / 103
A NGULAR V ELOCITY OF R IGID
B ODY (C ONTD .)
Using relation between 0i [Ω]R and 0i [Ω]L
0 0 0 0 T 0
Vp = i [R] i [Ω]L i [R] p = 0i [R]0i [Ω]L i p
−1 0
to get 0i [R] V p = 0i [Ω]L i p
Yielding
i
Vp = 0i [Ω]L i p = 0 ω bi ×i p (12)
Except for denoting the reference (fixed) coordinate system, the coordinate
system {0} does not appear!
Body-fixed angular velocity vector is said to be independent of the choice of the
fixed coordinate system.
Unless explicitly stated, space-fixed angular velocity vector derived from
˙ 0 [R]T is normally used in kinematic analysis.
0 [R]
i i . . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 14 / 103
A NGULAR V ELOCITY IN S ERIAL
M ANIPULATOR – ROTARY (R) JOINT
For two links connected by a rotary (R) joint
i [R(k̂, θi )]
0
i [R] = 0i−1 [R] i−1
˙ 0 [R]T d 0
i [R(k̂, θi )]) i [R(k̂, θi )]
i−1 0
0 [R]
i = ( [R] (i−1 T T
i−1 [R] )
i
dt i−1
Rewrite above equation as
{T ool} X̂2
Link 3 θ3
ŶT ool l3 All joint axis are parallel and coming
O3
outwards.
{3} {0} is fixed →
Ŷ3 Link 2
Ŷ0
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 22 / 103
O UTLINE
1 C ONTENTS
2 L ECTURE 1
Introduction
Linear and Angular Velocity of Links
3 L ECTURE 2
Serial Manipulator Jacobian Matrix
4 L ECTURE 3
Parallel Manipulator Jacobian Matrix
5 L ECTURE 4
Singularities in Serial and Parallel Manipulators
6 L ECTURE 5
Statics of Serial and Parallel Manipulators
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 23 / 103
S ERIAL M ANIPULATOR JACOBIAN
M ATRIX
Linear and angular velocity of {Tool}
0
ω Tool = (0 0 θ̇1 + θ̇2 + θ̇3 )T (19)
and
−l1 s1 θ̇1 − l2 s12 (θ̇1 + θ̇2 ) − l3 s123 (θ̇1 + θ̇2 + θ̇3 )
0
VTool = l1 c1 θ̇1 + l2 c12 (θ̇1 + θ̇2 ) + l3 c123 (θ̇1 + θ̇2 + θ̇3 ) (20)
0
In a compact form as
−l1 s1 − l2 s12 − l3 s123 −l2 s12 − l3 s123 −l3 s123
l1 c1 + l2 c12 + l3 c123 l2 c12 + l3 c123 l3 c123
0 0 0 θ̇1
0
VTool =
−− −− −− θ̇2
(21)
0 0 0 θ̇3
0 0 0
1 1 1
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 24 / 103
S ERIAL M ANIPULATOR JACOBIAN
M ATRIX
0V
Tool
is a 6 × 1 entity – 0 VTool =
∆
0V
Tool −−
0ω
Tool
0V is not a 6 × 1 vector1 – different units for velocities!
Tool
Use ‘–’ or ‘;’ to separate the linear and angular velocities & to remind that
Tool or ( VTool ; ω Tool ) is not a vector.
0V 0 0 T
Matrix in square brackets, 0Tool [J(Θ)], is called the Jacobian matrix for the
planar 3R manipulator.
0
Tool [J(Θ)] relate the linear and angular velocities of the {Tool} with the joint
velocities.
Jacobian matrix is for the end-effector or the {Tool} — See subscript Tool.
Linear and angular velocities are in {0} — See leading superscript 0.
. . . . . . . . . . . . . . . . . . . .
1 In theoretical kinematics, (0 ω Tool ;0 VTool ) is called twist. . . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 25 / 103
P ROPERTIES OF M ANIPULATOR
JACOBIAN MATRIX
2 The condition number of a matrix is the ratio of the absolute value of the largest to the
. . . . . . . . . . . . . . . . . . . .
smallest eigenvalues. . . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 26 / 103
P ROPERTIES OF M ANIPULATOR
JACOBIAN MATRIX (C ONTD .)
0
Tool [J(Θ)] is a map 0
Tool [J(Θ)] : Θ̇ →0 VTool .
The manipulator Jacobian matrix can be derived3 for any serial manipulator
with rotary and prismatic joints
Compute the linear and angular velocities using propagation equations.
Rearrange in a matrix equation as done for the planar 3R manipulator.
0 is very important in velocity kinematics of serial manipulators.
Tool [J(Θ)]
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 29 / 103
G EOMETRIC I NTERPRETATION OF
MANIPULATOR JACOBIAN MATRIX
X̂2
Consider a planar 2R manipulator shown in
Figure.
The linear velocity V of the end-effector
(x, y) (point (x, y )) is
Link 2
Ŷ0 ( )
∆ ẋ
l2 V=
θ2 X̂1 ẏ
[ ]( )
{0} −l1 s1 − l2 s12 −l2 s12 θ˙1
=
l1 c1 + l2 c12 l2 c12 θ˙2
O2
Link 1
l1
where θ̇1 , θ̇2 are joint rates.
θ1
The matrix in square brackets is the Jacobian
X̂0 matrix in {0}.
O1
. . . . . . . . . . . . . . . . . . . .
F IGURE : A planar 2R manipulator . . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 30 / 103
G EOMETRIC I NTERPRETATION OF
M ANIPULATOR JACOBIAN MATRIX
[ g ]Θ̇ − λ Θ̇ = 0 (25)
[ g ] real, symmetric and positive definite → Eigenvalues are always real and
positive.
For λ1 > λ2 , √ √
|V|max = λ1 , λ2
|V|min =
√ √
For square Jacobian matrix, eigenvalues of [J(Θ)] are λ1 and λ2 (see
Strang 1976).
√ √
Maximum and minimum |V| for 2R manipulator are λ1 and λ2 .
If θ̇12 + θ̇22 = k 2 is used → Maximum and minimum |V| are scaled by k.
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 33 / 103
G EOMETRIC I NTERPRETATION
(C ONTD .)
From V = [J(Θ)]Θ̇, [J]T V = [ g ]Θ̇
For non-singular [ g ],
T
VT ([J][ g ]−1 )([J][ g ]−1 )T V = Θ̇ Θ̇
For planar 2R manipulator, ([J][ g ]−1 )([J][ g ]−1 )T is symmetric and of rank 2
T
→ for Θ̇ Θ̇ = 1, (ẋ, ẏ )T ([J][ g ]−1 )([J][ g ]−1 )T (ẋ, ẏ ) = 1.
xT [A]x = 1, with [A] symmetric, positive definite, describes an ellipse.
The tip of the linear velocity vector
√ traces an
√ ellipse and the semi-major and
semi-minor axes of the ellipse are λ1 and λ2 , respectively.
T
For Θ̇ Θ̇ = k 2 , size of ellipse is scaled by k, but shape of ellipse does not
change with k.
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 34 / 103
G EOMETRIC I NTERPRETATION
(C ONTD .)
Eigenvalues of [ g ] are only
functions of θ2 → Shape and size of
ellipse will change with θ2 .
(x, y)
Can plot ellipses at all points in the Ŷ0 Link 2
workspace l2
θ2
Recall: workspace of a planar 2R is {0}
the area between two circles of radii
O2
l1 + l2 and l1 − l2 . l1 Link 1
The shape of the velocity ellipse indicates which directions are ‘easier’ to move
for given joint rates
|V| is larger along major axis → Easier to move along major axis.
Less easier to move along the minor axis.
Ellipse reduces to a circle → Equally easy to move in all directions.
All points in the workspace, where the ellipse is a circle, are called isotropic (see
Salisbury, 1982)
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 36 / 103
G EOMETRIC I NTERPRETATION
(C ONTD .)
Isotropic configuration — Eigenvalues of [J(Θ)] (or [ g ]) are equal.
For planar 2R, eigenvalues equal only if
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 39 / 103
N ON - SQUARE JACOBIAN
Some properties of pseudo-inverse
Dimension of [J(Θ)]# is n × m – Not square!
Left inverse → [J(Θ)][J(Θ)]# = [U] – Identity matrix.
Not a right inverse [J(Θ)]# [J(Θ)] ̸= [U]
General solution to 0 VTool =0Tool [J(Θ)]Θ̇ is
0 0
Tool [Jω (q)], Tool [JV (q)]
– Angular and linear velocity Jacobian.
q̇ – Time derivatives of configuration variables q.
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 43 / 103
E LIMINATION OF PASSIVE JOINT
RATES
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 44 / 103
E LIMINATION OF PASSIVE JOINT
RATES
For m passive variables, m constraint equations ηi (q1 , ..., qn+m ) = 0, i = 1, ..., m
or in a vector form
η (q) = η (θ , ϕ ) = 0 (27)
Differentiate equation (27) with respect to t, and rearrange
Columns of the m × n matrix [K (q)] are the partial derivatives of η (q) with
respect to the actuated variables θi , i = 1, ..., n,
Columns of m × m matrix [K ∗ (q)] are the partial derivatives of η (q) with respect
to the passive variables ϕi , i = 1, ..., m.
[K ∗ (q)] is always an m × m square matrix.
[K (q)] and [K ∗ (q)] are functions q = (θ , ϕ ) ∈ ℜn+m . . . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 45 / 103
E LIMINATION OF PASSIVE JOINT
RATES
If det([K ∗ ]) ̸= 0,
ϕ̇ = −[K ∗ ]−1 [K ]θ̇ (29)
The angular and linear velocity can partitioned as
∗
0
ω Tool = [Jω ]θ̇ + [Jω ]ϕ̇ , 0
VTool = [JV ]θ̇ + [JV∗ ]ϕ̇
Substitute ϕ̇ to get
∗
0
ω Tool = ([Jω ] − [Jω ][K ∗ ]−1 [K ])θ̇ , 0
VTool = ([JV ] − [JV∗ ][K ∗ ]−1 [K ])θ̇
The 6 × n matrix, 0
Tool [Jeq ], consists of 3 × n rows from [JV ]eq and 3 × n rows
from [Jω ]eq .
The matrix 0 is the Jacobian matrix5 for parallel manipulators.
Tool [Jeq ]
At a known q, equation (32) relate actuated joint rates θ̇ to the linear and
angular velocity of chosen end-effector {Tool}.
5 Not . . . . . . . . . . . . . . . . . . . .
a “true Jacobian” as it is not obtained from the derivative of a vector
. . . valued
. . . . . function.
. . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 47 / 103
E QUIVALENT JACOBIAN MATRIX IN
PARALLEL MANIPULATORS
[ gV ]eq = ([JV ] − [JV ∗ ][K ∗ ]−1 [K ])T ([JV ] − [JV ∗ ][K ∗ ]−1 [K ]) (33)
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 48 / 103
E XAMPLE – P LANAR 4- BAR
φ3
MECHANISM
O2
Link 2
X̂2
O3
l2
X̂3
φ2
Ŷ L
l3 ŶR
Link 1 Link 3
{L} l1
{R}
X̂1
φ1
θ1 X̂L
l0
X̂R
OT ool , OR
OL , O1
X̂T ool
θ1 is the actuated joint variable and (ϕ1 , ϕ2 ) are the passive joint variables.
Derivative of constraint equations with respect to time t gives
( )
−l1 sin θ1 − l2 sin(θ1 + ϕ2 )
θ˙1 +
l1 cos θ1 + l2 cos(θ1 + ϕ2 )
( )( )
l3 sin ϕ1 −l2 sin(θ1 + ϕ2 ) ϕ˙1
=0
−l3 cos ϕ1 l2 cos(θ1 + ϕ2 ) ϕ˙2
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 50 / 103
E XAMPLE – P LANAR 4- BAR
MECHANISM
S3 S2
S1 l2
Axis of R1
X̂
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 53 / 103
E XAMPLE – 3-RPS PARALLEL
MANIPULATOR
[K ∗ ] involves derivative with respect to passive joint variables, θ
3l1 s1 − l1 l2 s1 c2 − 2l1 l2 c1 s2 3l2 s2 − l1 l2 c1 s2 − 2l1 l2 s1 c2 0
0 3l2 s2 − l2 l3 s2 c3 − 2l2 l3 c2 s3 3l3 s3 − l2 l3 c2 s3 − 2l2 l3 s2 c3
3l1 s1 − l1 l3 s1 c3 − 2l1 l3 c1 s3 0 3l3 s3 − l1 l3 c1 s3 − 2l1 l3 s1 c3
and
l1 s1 −(1/2)l
√ 2 s2 (−1/2)l
√ 3 s3
[JV ∗ ] = (1/3) 0 ( 3/2)l2 s2 (− 3/2)l3 s3
l 1 c1 l 2 c2 l 3 c3 . . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 54 / 103
E XAMPLE – 3-RPS PARALLEL
MANIPULATOR
Expressions for [JV ]eq and [Jω ]eq are more harder to obtain as [K ∗ ]−1 is
needed. For above numerical values
−0.2313 0.5372 0.0114 2.1409 −6.4331 0.4665
[JV ]eq = 0.0722 −0.6758 0.1951 , [Jω ]eq = 0.0072 −4.1216 1.6048
1.1765 −1.6830 0.9223 0.1565 0.4570 −0.3285
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 55 / 103
E XAMPLE – 3-RPS PARALLEL
MANIPULATOR
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 56 / 103
E XAMPLE – 3-RPS MANIPULATOR
0.4 0.4
0.2 0.2
Vy
Vz
0 0
−0.2 −0.2
−0.4 −0.4
−0.4 −0.2 0 0.2 0.4 −0.4 −0.2 0 0.2 0.4
Vx Vx
0.4
0.5
0.2
Vz
0
Vz
−0.2 −0.5
0.5
0.5
0 0
−0.4
−0.4 −0.2 0 0.2 0.4 Vy −0.5 −0.5 Vx
Vy
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 58 / 103
O UTLINE
1 C ONTENTS
2 L ECTURE 1
Introduction
Linear and Angular Velocity of Links
3 L ECTURE 2
Serial Manipulator Jacobian Matrix
4 L ECTURE 3
Parallel Manipulator Jacobian Matrix
5 L ECTURE 4
Singularities in Serial and Parallel Manipulators
6 L ECTURE 5
Statics of Serial and Parallel Manipulators
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 59 / 103
S ERIAL MANIPULATORS – R EVIEW
Direct velocity kinematics
0
VTool = 0Tool [J(Θ)]Θ̇
For known Θ and Θ̇, linear and angular velocity of end-effector obtained from
above equation.
0
VTool always exists
Inverse velocity kinematics
−1 0
Θ̇ = 0Tool [J(Θ)] VTool
∗
][K ∗ ]−1 [K ]
∆
[Jω ]eq = [Jω ] − [Jω
Equivalent Jacobian
[JV ]eq
0
Tool [J]eq =
−−
[Jω ]eq
det(0Tool [Jeq ]) = 0 → End-effector loses one or more degrees of freedom →
Actuated joint rates Θ̇ → ∞.
Similar to serial manipulators — At singularity velocity ellipse or ellipsoid
degenerates. . . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 64 / 103
PARALLEL MANIPULATORS – G AIN
SINGULARITY
[K ∗ (q)]ϕ̇ = 0
∗
From linear algebra, non-zero solution ϕ̇ exists when det([K ∗ ]) = 0.
∗
ϕ̇ is the eigenvector corresponding to the zero eigenvalue of [K ∗ ].
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 65 / 103
PARALLEL MANIPULATORS – G AIN
SINGULARITY
∗
For a non-zero ϕ̇ , and θ̇ = 0,
∗
0
ω Tool = [Jω ∗ ]ϕ̇
∗
0
VTool = [JV ∗ ]ϕ̇
Even with actuators locked the linear and angular velocity are non-zero.
The end-effector of the parallel manipulator can instantaneously gain one or
more degrees of freedom.
Termed as gain singularity.
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 66 / 103
PARALLEL MANIPULATORS – G AIN
SINGULARITY
l2
l3
Link 2
Link 3
φ2
Link 2
Ŷ L l2
ŶR
Link 1
{L} l1 O3
{R}
l3
Link 3 φ1
θ1 X̂L
l0 X̂R
OR
OL , O1
det([K ∗ ]) = 0 → l2 l3 sin(θ1 + ϕ2 − ϕ1 ) = 0 → θ1 + ϕ2 − ϕ1 = nπ → ϕ3 = 2π ,
Link 2 and 3 are parallel.
Instantaneous gain: θ1 locked, point O2 is fixed → Link 2 and link 3 along a
straight line → O3 can have instantaneous velocity along the common tangent..
. . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 71 / 103
S INGULARITIES IN PARALLEL
MANIPULATORS – E XAMPLES
Example – The 3-RPS parallel manipulator (see Basu and Ghosal, 1997)
For the 3-RPS parallel manipulator,
det([JV ]eq ) = 0 → Linear velocity ellipsoid described by the centroid of the top
platform degenerates to an ellipse.
For (l1 , l2 , l3 ) = (0.5, 1.0, 1.9710) meters and
(θ1 , θ2 , θ3 ) = (1.1691, 0.4781, 0.2355) radians → det([JV ]eq ) = 0.
The linear velocity ellipse at this configuration is shown in sectional and a 3D
view in Figure.
Not a contradiction to result by Hunt (1991)
The 3-RPS parallel manipulator is not a six DOF manipulator, and
Only the linear velocity vector of the centroid is considered.
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 72 / 103
E XAMPLE – 3-RPS MANIPULATOR
2 2
1 1
Vy
Vz
0 0
−1 −1
−2 −2
−2 −1 0 1 2 −2 −1 0 1 2
Vx Vx
2
1
Vz
0
Vz
−1 −2
2
2
0 0
−2
−2 −1 0 1 2 Vy −2 −2 Vx
Vy
det([K ∗ ]) =
(3l1 s1 − l1 l2 s1 c2 − 2l1 l2 c1 s2 ) × (3l2 s2 − l2 l3 s2 c3 − 2l2 l3 c2 s3 ) ×
(3l3 s3 − l1 l3 c1 s3 − 2l1 l3 s1 c3 )
+(3l1 s1 − l1 l3 s1 c3 − 2l1 l3 c1 s3 ) × (3l2 s2 − l1 l2 c1 s2 − 2l1 l2 s1 c2 ) ×
(3l3 s3 − l2 l3 c2 s3 − 2l2 l3 s2 c3 ) = 0
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 75 / 103
E XAMPLE – 3-RPS MANIPULATOR
0.05 1
0.5
Vy
Vz
0 0
−0.5
−0.05 −1
−0.1 −0.05 0 0.05 0.1 −0.1 −0.05 0 0.05 0.1
Vx Vx
1
0.5
Vz
0
Vz
−0.5 −1
0.05
0.1
0 0
−1
−0.05 0 0.05 Vy −0.05 −0.1 Vx
Vy
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 77 / 103
E XAMPLES - 3-RPS MANIPULATOR
1.5 1
1
0.5
0.5
Vy
Vz
0 0
−0.5
−0.5
−1
−1.5 −1
−0.4 −0.2 0 0.2 0.4 −0.4 −0.2 0 0.2 0.4
Vx Vx
1
0.5
Vz
0
Vz
−0.5 −1
2
0.5
0 0
−1
−2 −1 0 1 2 Vy −2 −0.5 Vx
Vy
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 79 / 103
O UTLINE
1 C ONTENTS
2 L ECTURE 1
Introduction
Linear and Angular Velocity of Links
3 L ECTURE 2
Serial Manipulator Jacobian Matrix
4 L ECTURE 3
Parallel Manipulator Jacobian Matrix
5 L ECTURE 4
Singularities in Serial and Parallel Manipulators
6 L ECTURE 5
Statics of Serial and Parallel Manipulators
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 80 / 103
S TATICS OF S ERIAL AND PARALLEL
M ANIPULATORS
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 81 / 103
S ERIAL MANIPULATORS – S TATICS
ni+1 {i + 1} Ẑi+1 fi+1
Ŷi+1
Ẑi
{i} i
Oi+1
Oi+1 X̂i+1
ni
Two intermediate rotary (R) joints
and a link of a manipulator.
Ŷi Link i
Oi fi and ni denote the forces and
moments exerted on link {i} by link
X̂i {i − 1}.
fi
fi +1 is the force on link {i + 1} exerted by link {i} → Force on link {i} exerted
by link {i + 1} will be equal and of opposite sign.
The leading superscript i signifies that the vectors are described in {i}.
fy = −s123
′ c123 0 fy l1 O2
τ1 Link 1
0 0 0 1 0
θ1
i=2
2
f2 = (c3 fx′ − s3 fy′ , s3 fx′ + c3 fy′ , 0)T
2
n2 = (0, 0, nz′ + l2 (s3 fx′ + c3 fy′ ) + l3 fy′ )T
i=1
1
f1 = (c23 fx′ − s23 fy′ , s23 fx′ + c23 fy′ , 0)T
1
n1 = (0, 0, nz′ + l1 (s23 fx′ + c23 fy′ ) + l2 (s3 fx′ + c3 fy′ ) + l3 fy′ )T
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 86 / 103
S TATICS – E XAMPLE 3R PLANAR
MANIPULATOR
Note: 0 FTool is not a 6 × 1 vector since forces and moments have different
units.
0F is called a wrench in theoretical kinematics, and a wrench can be
Tool
thought of as screw with a magnitude which has units of force.
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 88 / 103
F ORCE TRANSFORMATION MATRIX
Consider an infinitesimal Cartesian displacement of the end effector 0 δ X Tool 7
and the virtual work done by 0 FTool
Equating virtual work done by external force/moment and at joints
∆0
0
FTool ·0 δ X Tool = fTool · δ x +0 nTool · δ θ = τ · δ Θ
P Joint
Bi B0 S
Unit vector along leg B0 s = i
i li
B0
bi
X̂
{B0 }
U Joint
where B0 FTool , B0 M
Tool are the 3 × 1 force and moment vectors acting on
{Tool}.
In matrix form B0 F
Tool =B0
Tool [ H ]f
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 92 / 103
F ORCE TRANSFORMATION MATRIX
B0
The force transformation matrix Tool [ H ]
B0 s B0 s B0 s
1 2 ... 6
B0
Tool [ H ]= −−− −−− −−− −−− (39)
(B0 b1 ×B0 s1 ) (B0 b2 ×B0 s2 ) ... (B0 b6 ×B0 s6 )
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 93 / 103
PARALLEL MANIPULATORS –
S INGULARITY IN FORCE DOMAIN
8 In . . . . . . . . . . . . . . . . . . . .
velocity singularity, no joint rates can cause motion along certain (singular)
. . . . . . directions.
. . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 94 / 103
PARALLEL MANIPULATORS –
S INGULARITY IN FORCE DOMAIN
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 95 / 103
PARALLEL MANIPULATORS –
S INGULARITY IN FORCE DOMAIN
rank([gF ]) = 2 → Force ellipsoid shrinks to an ellipse and the Stewart platform
manipulator cannot apply a force normal to the plane of the ellipse.
rank([gF ]) = 1 or 0, the Stewart platform cannot apply any force in a plane or
cannot apply any external force, respectively.
Example:
Stewart-Gough platform with fixed base and moving platform as regular
hexagons of same size.
Consider the configuration of all legs parallel to the vertical.
[ H ] matrix is given by
0 0 0 0 0 0
0 0 0 0 0 0
1 1 1 1 1 1
[H] =
b1y b2y b3y b4y b5y b6y
−b1x −b2x −b3x −b4x −b5x −b6x
0 0 0 0 0 0
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 96 / 103
PARALLEL MANIPULATORS –
S INGULARITY IN FORCE DOMAIN
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 97 / 103
R ELATION BETWEEN GAIN AND
FORCE SINGULARITY
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 98 / 103
R ELATION BETWEEN GAIN
F
φ3
AND FORCE SINGULARITY O2
Link 2
O3
φ2
ŶL
d l3 ŶR
Link 1 Link 3
{L} l1
{R}
τ1 φ1
θ1 X̂L
l0
X̂R
OR
OL , O1 Fig a
Ŷ O3
T2
T1 γ
l2 l3
O2 α1
R1 α2 OR
X̂
R2 Fig b
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 100 / 103
R ELATION BETWEEN GAIN
AND FORCE SINGULARITY
T1 and T2 are
( ) [ ]( )
T1 1 sin α2 cos α2 Fx
=
T2 sin(α1 + α2 ) − sin α1 cos α1 Fy
. . . . . . . . . . . . . . . . . . . .
. . . . . . . . . . . . . . . . . . . .
A SHITAVA G HOSAL (IIS C ) ROBOTICS : BASICS AND A DVANCED C ONCEPTS NPTEL, 2020 101 / 103
R ELATION BETWEEN GAIN
AND FORCE SINGULARITY
From T1 obtain reactions R1 and R2 at the joint O2
( ) [ ]( )
R1 1 cos α1 sin α2 cos α1 cos α2 Fx
=
R2 sin(α1 + α2 ) sin α1 sin α2 sin α1 cos α2 Fy
• D. Basu and A. Ghosal 1997 “Singularity analysis of platform-type multi-loop spatial mech-
anism”, Mechanism and Machine Theory, Vol. 32, pp. 375-389.
• A. Ghosal and B. Ravani 1998, “A dual ellipse is a cylindroid”, Proc. of ASME DETC’98,
Atlanta, USA, September 1998.
• A. Ghosal and B. Ravani 2001, “Differential geometric analysis of singularities of point trajec-
tories of serial and parallel manipulators”, Trans. of ASME, Journal of Mechanical Design,
Vol. 123, pp. 80-89.
• C. Gosselin and J. Angeles 1990, “Singularity analysis of closed loop kinematic chains”, IEEE
Trans. on Robotics and Automation, Vol. 6, pp. 281-290.
• K. H. Hunt 1986, “Special configurations of robot arms via screw theory, Part 1. The Jacobian
and its matrix cofactors”, Robotica, Vol. 4, pp. 171-179.
• J.-P. Merlet 1991, “Singularity configurations of parallel manipulators and Grassman geom-
etry”, The International Journal of Robotics Research, Vol. 10, No. 2, pp. 123-134.
• F. C. Park and J. W. Kim 1999, “Singularity analysis of closed loop kinematic chains”, Trans.
of ASME, Journal of Mechanical Engineering Design, Vol. 121, No. 1, pp. 32-38.
• J. K. Salisbury 1982, Kinematics and force analysis of articulated hands, Ph. D. Thesis,
Stanford University.