Lecture Robotics DH
Lecture Robotics DH
&
A NALYSIS
M ODULE 2 E LEMENTS OF ROBOTS : JOINTS ,
ACTUATORS & SENSORS
LINKS ,
Ashitava Ghosal1
1 Department
of Mechanical Engineering
&
Centre for Product Design and Manufacture
Indian Institute of Science
Bangalore 560 012, India
Email: [email protected]
NPTEL, 2010
.
NPTEL, 2010
1 / 138
.
. .1 C ONTENTS
.
. .2 L ECTURE 1
Mathematical Preliminaries
Homogeneous Transformation
.
. .3 L ECTURE 2
Elements of a robot Joints
Elements of a robot Links
.
. .4 L ECTURE 3
Examples of D-H Parameters & Link Transformation
Matrices
.
. .5 L ECTURE 4
Elements of a robot Actuators & Transmission
.
. .6 L ECTURE 5
Elements of a robot Sensors
.
. .7 A DDITIONAL M ATERIAL
Problems, References, and Suggested Reading
.
NPTEL, 2010
2 / 138
O UTLINE
.
. .1 C ONTENTS
.
. .2 L ECTURE 1
Mathematical Preliminaries
Homogeneous Transformation
..3 L ECTURE 2
.
Elements of a robot Joints
Elements of a robot Links
..4 L ECTURE 3
.
Examples of D-H Parameters & Link Transformation
Matrices
. L ECTURE 4
.
5
.
Elements of a robot Actuators & Transmission
..6 L ECTURE 5
.
Elements of a robot Sensors
..7 A DDITIONAL M ATERIAL
.
Problems, References, and Suggested Reading
.
NPTEL, 2010
3 / 138
A
Z
{A}
A
Y
OA
Rigid Body A
A
X
Origin OA .
Set of 3 mutually
orthogonal axis
A, Y
A and Z
A
Unitvectors X
are along the index finger,
the middle finger and the
thumb of the right-hand,
respectively.
Label to keep track {A}.
A = (px , py , pz )T
A + pz Z
A + py Y
p = px X
.
(1)
.
NPTEL, 2010
4 / 138
{A}
B
Z
{B}
Attach coordinate
system, {B}, to rigid
body B.
p
B
Y
A
Y
OA ,OB
Rigid Body B
A
X
Origin of {B}
coincident with origin of
{A} (see Figure 2).
Obtain description of
{B} with respect to
{A}.
B
X
NPTEL, 2010
5 / 138
XB
A
YB
A + r21 Y
A + r31 Z
A
= r11 X
A + r22 Y
A + r32 Z
A
= r12 X
A + r23 Y
A + r33 Z
A
= r13 X
ZB
(2)
NPTEL, 2010
6 / 138
O RIENTATION P ROPERTIES OF A
B [R]
The vector B p in rigid body B can be described in {A} by
A
B
p=A
B [R] p
(3)
A
Inverse is same as transpose B
A [R] = B [R]
=A
B [R] .
, where = 1,
Three eigenvalues of A
B [R] are +1, e
and = cos1 ( r11 +r222+r33 1 ).
The eigenvector corresponding to +1 is
= (1/2 sin )[r32 r23 , r13 r31 , r21 r12 ]T , = {0, n },
k
where n is a natural number. For = {0, 2n }, there is no
rotation and = 2(n 1) needs to handled specially!
1 det(A [R]) = +1
B
A SHITAVA G HOSAL (IIS C )
NPTEL, 2010
7 / 138
)
O RIENTATION U SING (k,
fixed in {A} and {B}: A k
= A [R]B k
= 1B k.
Rotation axis k
B
First equality is transformation of a vector from {B} to
{A} and the second equality follows from equation (3) and
the definition of an eigenvector.
T
Elements of A
B [R] in terms of (kx , ky , kz ) and angle
r11 = kx 2 (1 cos ) + cos
r12 = kx ky (1 cos ) kz sin
r13 = kz kx (1 cos ) + ky sin
r21 = kx ky (1 cos ) + kz sin
r22 = ky 2 (1 cos ) + cos
(4)
NPTEL, 2010
8 / 138
1
0
0
A
0 cos sin
B [R] = [R(X, )] =
0 sin cos
(5)
A
Z
{A}
B
Z
{B}
B
p
B
Y
OA , OB
Rotation about X
shown in Figure 3.
A
Y
A, X
B
X
Rigid Body B
by angle
Figure 3: Rotation about X
A SHITAVA G HOSAL (IIS C )
NPTEL, 2010
9 / 138
and Z
Rotation about Y
cos
)] =
0
[R(Y,
sin
cos
)] = sin
[R(Z,
0
0 sin
1
0
0 cos
(6)
0
0
1
(7)
sin
cos
0
NPTEL, 2010
10 / 138
S UCCESSIVE ROTATIONS
Two successive rotations:
....
..
...
1
2
Resultant rotation:
A [R] = A [R] B1 [R] Note order
B
B1
B
of matrix multiplication.
A
Z
{A}
B
Z
{B}
B
Y
1
B
Z
1
B
Y
A
Y
OA ,OB1 ,OB
A
X
Rigid Body B
B1
X
B
X
Rigid Body B1
Resultant of n rotations
A [R] = A [R] B1 [R] ... Bn1 [R]
B
B1
B2
B
Matrix multiplication is non
commutative in general
A [R] B1 [R] = B1 [R] A [R]
B1
B1
B
B
Order of rotation is important!
.
NPTEL, 2010
11 / 138
NPTEL, 2010
12 / 138
1
0
0
A [R] = [R(X,
1 )] = 0 cos 1 sin 1
Rotation about X
B1
0 sin 1
cos 1
0 sin 2
cos 2
B
1
[R] = [R(Y,
2 )] =
0
1
0
Rotation about Y
B2
sin 2 0 cos 2
A, X
B1
X
{A}
B2
X
A, X
B1
X
{B1 }
{A}, {B1 }
{B}
B
X
{B2 }
1
{B2 }
A, X
B1
X
{A}, {B1 }
B2
X
B
Z
2
B
Z
1
B, Z
B
Z
2
B
Z
1
B1
Z
OA , OB
A
Z
A
Y
A
Y
B1
Y
OA , OB
2
A
Z
A
Z
OA , OB
A
Y
B
Y
B1 , Y
B2
Y
B
Y
1
NPTEL, 2010
13 / 138
cos 3 sin 3 0
B2
sin 3 cos 3 0
B [R] = [R(Z, 3 )] =
0
0
1
B1
B2
A
=
Resultant rotation A
B [R] = B1 [R] B2 [R] B [R]
c2 c3
c2 s3
s2
s1 s2 c3 + s3 c1 s1 s2 s3 + c3 c1 s1 c2
c1 s2 c3 + s3 s1 c1 s2 s3 + c3 s1
c1 c2
Note: ci , si denote cos i and sin i , respectively.
A [R]
B
A [R]
B
NPTEL, 2010
14 / 138
2 + r 2 ))
2 = atan2(r13 , (r11
12
1 = atan2(r23 / cos 2 , r33 / cos 2 )
3 = atan2(r12 / cos 2 , r11 / cos 2 )
Else
If r13 = 1, 1 = atan2(r21 , r22 ), 2 = /2, 3 = 0
If r31 = 1, 1 = atan2(r21 , r22 ), 2 = /2, 3 = 0
atan2(y , x): four-quadrant arc-tangent function (see
R
function atan2 in MATLAB
) 1 , 2 , 3 [ , ].
Two sets of values of 1 , 2 and 3 .
NPTEL, 2010
15 / 138
B
Z
2
{B1 }
{A}, {B1 }
{B2 }
1
B2 , Z
B
Z
A, Z
B
Z
1
B
Y
1
A, Z
B
Z
1
{A}
{B}
B
Y
B1 , Y
B2
Y
2
B , Y
B
Y
1
2
OA , OB
A
X
A
Y
OA , OB
A
X
B1
X
B1
X
A
Y
A
Y
OA , OB
A
X
B
X
2
B1
X
B
X
B2
X
A [R]
B
c1 s1 0
c2
0 s2
s1
c1
0 0
1 0
s2 0 c2
0
1
0
c1 c2 c3 s1 s3 c1 c2 s3 s1 c3
s1 c2 c3 + c1 s3 s1 c2 s3 + c1 c3
s2 c3
s2 s3
c3
s3
0
c1 s2
s1 s2
c2
0
0
1
s3
c3
0
(8)
.
NPTEL, 2010
16 / 138
NPTEL, 2010
17 / 138
OTHER R EPRESENTATIONS
Euler parameters (see Kane et al., 1983, McCarthy, 1990):
= (kx , ky , kz )T and angle
4 parameters derived from k
sin /2
3 parameters = k
fourth parameter 4 = cos /2
One constraint 1 2 + 2 2 + 3 2 + 4 2 = 1
Q = q0 + q1i + q2j + q3 k.
i, j, and k
are the unit vectors in 3 .
Product of two quaternion also a quaternion.
Inverse of quaternion exists.
q02 + q12 + q22 + q32 = 1 Unit quaternion represent
orientation of a rigid body in 3 .
2 See
NPTEL, 2010
18 / 138
NPTEL, 2010
19 / 138
C OMBINED
T RANSLATION
AND
O RIENTATION OF A R IGID B ODY
A
Z
Rigid Body B
{A}
B
Z
{B}
OB
A
A
OB
B
Y
B
=A OB + A
B [R] p
AO
A
Y
OA
A
X
B locates OB with
respect to OA .
B
X
NPTEL, 2010
20 / 138
O UTLINE
.
. .1 C ONTENTS
.
. .2 L ECTURE 1
Mathematical Preliminaries
Homogeneous Transformation
..3 L ECTURE 2
.
Elements of a robot Joints
Elements of a robot Links
..4 L ECTURE 3
.
Examples of D-H Parameters & Link Transformation
Matrices
. L ECTURE 4
.
5
.
Elements of a robot Actuators & Transmission
..6 L ECTURE 5
.
Elements of a robot Sensors
..7 A DDITIONAL M ATERIAL
.
Problems, References, and Suggested Reading
.
NPTEL, 2010
21 / 138
4 4 T RANSFORMATION M ATRIX
B
Combined translation and orientation A P = A
B [T ] P
NPTEL, 2010
22 / 138
4 4 T RANSFORMATION M ATRIX
P ROPERTIES
A [T ] is given by
Inverse of (
B
)
A [R]T
A [R]T A O
A [T ]1 =
B
B
B
B
0
0
0
1
NPTEL, 2010
23 / 138
P ROPERTIES OF A
B [T ] (C ONTD .)
, same as for
Four eigenvalues of A
B [T ] are +1, +1, e
A [R].
B
No other eigenvector!
Eigenvectors for +1 is k
A [T ] represents the general motion of a rigid body in 3D
B
space 6 parameters must be present.
General motion of rigid body as a twist Rotation about
a line and translation along the line.
Direction of the line: (kx , ky , kz )T 2 independent
parameters.
Rotation about the line: angle 1 independent
parameter.
Y k)
where
Location of the line in 3 : (k,
T
Y=
A
([U]A
B [R] ) OB
2(1cos )
and Y k.
4 independent parameters in k
A
NPTEL, 2010
24 / 138
S UMMARY
A rigid body B in 3D space has 6 DOF with respect to
another rigid body A: 3 for position & 3 for orientation.
Y, Z and origin OA .
Rigid body B conceptually identical to a coordinate system
{B}.
Position of rigid body Position of a point of interest on
rigid body with respect to coordinate system {A} 3
Cartesian coordinates: A p = (px , py , pz )T .
Orientation described in many ways: 1) by 3 3 rotation
matrix A
B [R], 2) ( , k) or angle-axis form, 3) 3 Euler
angles, 4) Euler parameters & quaternions.
Algorithms available to convert one representation to
another.
4 4 homogeneous transformation matrix, A
B [T ], represent
position and orientation in a compact manner.
Properties of A
.
.
.
.
B [T ] can be related to a. screw.
A SHITAVA G HOSAL (IIS C )
NPTEL, 2010
25 / 138
O UTLINE
.
. .1 C ONTENTS
.
. .2 L ECTURE 1
Mathematical Preliminaries
Homogeneous Transformation
..3 L ECTURE 2
.
Elements of a robot Joints
Elements of a robot Links
..4 L ECTURE 3
.
Examples of D-H Parameters & Link Transformation
Matrices
. L ECTURE 4
.
5
.
Elements of a robot Actuators & Transmission
..6 L ECTURE 5
.
Elements of a robot Sensors
..7 A DDITIONAL M ATERIAL
.
Problems, References, and Suggested Reading
.
NPTEL, 2010
26 / 138
J OINTS I NTRODUCTION
A joint connects two or more links.
A joint imposes constraints on the links it connects.
2 free rigid bodies have 6 + 6 degrees of freedom.
Hinge joint connecting two free rigid bodies 6 + 1
degrees of freedom.
Hinge joint imposes 5 constraints, i.e., hinge joint allows 1
relative (rotary) degree of freedom.
NPTEL, 2010
27 / 138
T YPES OF J OINTS
DOF
NPTEL, 2010
28 / 138
C ONSTRAINTS IMPOSED
ROTARY (R) JOINT
BY
{i}
Rigid Body i 1
Oi
i
{i 1}
i1
Oi1
Rigid Body i
Oi1
Oi
Li
Rotary Joint
{0}
NPTEL, 2010
29 / 138
C ONSTRAINTS IMPOSED BY
ROTARY (R) JOINT IN A LOOP
k
{i}
i
Rigid Body i 1
Oi
i
{i 1}
i1
Rotary joint in a
loop 2 ends {L}
and {R}.
Oi1
Oi
Rigid Body i
Li
L
Rotary Joint
{R}
Oi1
{L}
L [R] i1 [R(k,
i )]
i1
i
Two constraints in
=
= LR [R]R
i [R]
since i is an unknown variable.
Three constraints in
L p =L O
L
i1 p =L D +R O + R [R]i p
i1 + i1 [R]
i
i
.
NPTEL, 2010
30 / 138
C ONSTRAINTS IMPOSED
PRISMATIC (P) JOINT
Two rigid bodies,
{i 1} and {i},
connected by a
sliding/prismatic (P)
joint
Orientation of {i} is
same as {i 1} 3
independent constraints
in 0i [R] = 0i1 [R]
{i} can slide by di ,
along Li , with respect
to {i 1}
BY
k
{i}
Rigid Body i 1
Oi
di
i
{i 1}
i1
Rigid Body i
Oi1
0
0
0
Oi1
Li
Oi
Prismatic Joint
{0}
=0 Oi + 0 [R]i p
2 constraints in 0 Oi1 + 0i1 [R]i1 p + di k
i
since di is an unknown variable.
.
NPTEL, 2010
31 / 138
C ONSTRAINTS IMPOSED
SPHERICAL (S) JOINT
BY
{i}
Rigid Body i 1
{i 1}
i1
Rigid Body i
0
0
Oi1
Oi
Spherical Joint
{0}
3 constraints:
0p
=0
=0 Oi + 0i [R]i p
.
NPTEL, 2010
32 / 138
C ONSTRAINTS IMPOSED
H OOKE (U) JOINT
BY
i1
NPTEL, 2010
33 / 138
C ONSTRAINTS IMPOSED BY A
SPHERICAL - SPHERICAL (SS) JOINT
PAIR
Rigid Body j
{j}
Sj
Rigid Body i
lij
Si
Sj
{i}
i
Si
S-S Pair
R
Oi
Sj
Si
{L}
NPTEL, 2010
34 / 138
O UTLINE
.
. .1 C ONTENTS
.
. .2 L ECTURE 1
Mathematical Preliminaries
Homogeneous Transformation
..3 L ECTURE 2
.
Elements of a robot Joints
Elements of a robot Links
..4 L ECTURE 3
.
Examples of D-H Parameters & Link Transformation
Matrices
. L ECTURE 4
.
5
.
Elements of a robot Actuators & Transmission
..6 L ECTURE 5
.
Elements of a robot Sensors
..7 A DDITIONAL M ATERIAL
.
Problems, References, and Suggested Reading
.
NPTEL, 2010
35 / 138
L INKS I NTRODUCTION
A link A is a rigid body in 3D space Can be described
by a coordinate system {A}.
A rigid body in 3 has 6 degrees of freedom 3 rotation
+ 3 translation 6 parameters (see Lecture 1)
For links connected by rotary (R) and prismatic (P),
possible to use 4 parameters Denavit-Hartenberg
(D-H)parameters (see Denavit & Hartenberg, 1955).
4 parameters since lines related to rotary(R) and prismatic
(P) joint axis are used.
For multi-degree-of-freedom joints Use equivalent
number of one-degree-of-freedom joints.
NPTEL, 2010
36 / 138
....
..
...
...
1
2
NPTEL, 2010
37 / 138
X
i
Z
i1
Z
{i 1}
Link i
{i}
Oi
Link i + 1
Link i 1
Link i 2
di
Li+1
i1
0
Z
i1
X
{0}
Li
Li1
Oi1
ai1
0
Y
0
X
NPTEL, 2010
38 / 138
NPTEL, 2010
39 / 138
Link offset di
i from X
i 1 to X
i Can be < 0.
Measured along Z
Joint i rotary di constant.
Joint i prismatic di is joint variable (see Figure 14).
Rotation angle i
i 1 and X
i measured about Z
i using
Angle between X
right-hand rule Between 0 and radians.
Joint i is prismatic i is constant.
Joint i rotary i is joint variable (see Figure 14).
.
NPTEL, 2010
40 / 138
NPTEL, 2010
41 / 138
ci
si
0
ai1
s c
i1
i i 1 ci ci 1 si 1 si 1 di (10)
i [T ] = s s
ci 1
ci 1 di
i i 1 ci si 1
0
0
0
1
3 The symbols s
i 1 , ci 1 denote sin(i1 ) and cos(i1 ),
respectively. Please see Notations in Module 0. .
.
.
A SHITAVA G HOSAL (IIS C )
NPTEL, 2010
42 / 138
link i.
Position and orientation of link i determined by i1 and
ai1 . Note: subscript i 1 in the twist angle and length!
The mix of subscripts are a consequences of the D-H
convention used!
Link i with respect to {0} 0i [T ] = 01 [T ] 12 [T ] ...
i1
i [T ]
NPTEL, 2010
43 / 138
S UMMARY
Two elements of robots Links and joints.
Joints allow relative motion between connected links
Joints impose constraints.
Serial robots mainly use one-degree-of-freedom rotary (R)
and prismatic (P) actuated joints.
Parallel and hybrid robots use passive
multi-degree-of-freedom joints and actuated
one-degree-of-freedom joints.
NPTEL, 2010
44 / 138
O UTLINE
.
. .1 C ONTENTS
.
. .2 L ECTURE 1
Mathematical Preliminaries
Homogeneous Transformation
..3 L ECTURE 2
.
Elements of a robot Joints
Elements of a robot Links
..4 L ECTURE 3
.
Examples of D-H Parameters & Link Transformation
Matrices
. L ECTURE 4
.
5
.
Elements of a robot Actuators & Transmission
..6 L ECTURE 5
.
Elements of a robot Sensors
..7 A DDITIONAL M ATERIAL
.
Problems, References, and Suggested Reading
.
NPTEL, 2010
45 / 138
S ERIAL M ANIPULATORS
Steps to obtain D-H parameters for a n link serial
manipulator (see Lecture 2 for details)
....
...
..
....
..
...
1
2
3
4
5
and Zi Xi 1 .
Origin Oi 1 on joint axis i 1.
Handle special cases a) consecutive joint axes parallel
and perpendicular, b) first and last link
Obtain 4 D-H parameters for link i, i 1 , ai 1 , di and i .
i1
i [T ]
NPTEL, 2010
46 / 138
P LANAR 3R
A SSIGNMENT
M ANIPULATOR
OF
COORDINATE
SYSTEMS
3, X
T ool
X
{T ool}
T ool
Y
2
X
Link 3
l3
O3
{3}
3
Y
0
Y
1
Y
Link 2
l2
2
Y
1
X
{2}
{0}
O2
{1}
Link 1
l1
1
0
X
O1
NPTEL, 2010
47 / 138
P LANAR 3R
A SSIGNMENT
M ANIPULATOR
OF
COORDINATE
SYSTEMS
1 are coincident with O0 and Z
0.
For {1} origin O1 and Z
1 and Y
1 are coincident with X
0 and Y
0 when 1 is zero.
X
1 is along the mutual perpendicular between Z
1 and Z
2.
X
2 is along the mutual perpendicular between Z
2 and Z
3.
X
3 is aligned to X
2 when 3 = 0.
For {3}, X
O2 is located at the intersection of the mutual
2 and Z
2.
perpendicular along X
O3 is chosen such that d3 is zero.
The origins and the axes of {1}, {2}, and {3} are shown in
Figure 15.
.
NPTEL, 2010
48 / 138
NPTEL, 2010
49 / 138
s1 c1 0 0
c2 0 0
1 [T ] = s2
2
0
0 1 0
0
0 0 1
Finally,
third row of D-H table
gives
c3 s3 0 l2
c3 0 0
2 [T ] = s3
3
0
0 1 0
0
0 0 1
.
NPTEL, 2010
50 / 138
The
3
Tool [T ]
is obtained as
3
Tool [T ]
1 0 0
0 1 0
0 0 1
0 0 0
4
and
get
0
0
1
2
To obtain
3 [T ] multiply 1 [T ] 2 [T ] 3 [T ]
c123 s123 0 l1 c1 + l2 c12
c123 0 l1 s1 + l2 s12
0 [T ] = s123
0
0
1
0
0
0
0
1
0
0
To obtain Tool [T ], multiply 3 [T ] 3Tool [T ]
0
s123 c123 0 l1 s1 + l2 s12 + l3 s123
Tool [T ] = 0
0
1
0
0
0
0
1
l3
0
0
1
NPTEL, 2010
51 / 138
2
X
2
Y
1
Z
{1}
3
Z
1
Y
{3}
O3
1
X
a2
3
X
d4
4
X
3
Y
d3
{4}
3
X
O1 , O2
a3
O4
O3
3
Y
6
X
5
X
{5}
{6}
4
X
4
Y
4
Z
{3}
6
Z
{4}
4
Z
5
Y
O4 , O5 , O6
NPTEL, 2010
52 / 138
i1
ai1
di
1
2
3
4
5
6
0
/2
0
/2
/2
/2
0
0
a2
a3
0
0
0
0
d3
d4
0
0
1
2
3
4
5
6
NPTEL, 2010
53 / 138
c2 s2 0 0
0
0 1 0
c3 s3 0 a2
s3 c3 0 0
NPTEL, 2010
54 / 138
c4 s4 0
0
0 1
From row # 4 , we get 34 [T ] =
s4 c4 0
0
0 0
c5 s5 0
0
0 1
From row # 5 , we get 45 [T ] =
s 5 c5
0
0
0
0
c6 s6 0
0
0 1
From row # 6 , we get 56 [T ] =
s6 c6 0
0
0 0
.
a3
d4
0
1
0
0
0
1
0
0
0
1
.
NPTEL, 2010
55 / 138
c1 c23 c1 s23 s1 a2 c1 c2 d3 s1
s1 c23 s1 s23 c1 a2 s1 c2 + d3 c1
s23 c23
0
a2 s2
0
0
0
1
{6} with respect to {3} is given by
3 [T ] = 3 [T ]4 [T ]5 [T ] =
6
4
5
6
c4 c5 c6 s4 s6 c4 c5 s6 s4 c6 c4 s5
s5 c6
s5 s6
c5
s4 c5 c6 c4 s6 s4 c5 s6 c4 c6
s4 s5
0
0
0
Can obtain any required link transformation
D-H is table known!
0 [T ]
3
a3
d4
0
1
matrix once
.
NPTEL, 2010
56 / 138
SCARA M ANIPULATOR
SCARA Selective
Compliance Assembly
Robot Arm
Z 2
Z 1
2
{ 2}
{ 1}
X 2
X 1
d3
{ 3}
O 0, O1
O2
Z 3
{ 4}
O3, O4
Capability of desired
compliance and rigidity
in selected directions.
Three rotary(R) joint
and one prismatic (P)
joint.
A 4 DOF manipulator.
NPTEL, 2010
57 / 138
SCARA
M ANIPULATOR :
D-H
PARAMETERS
{0} and {1} have same origin & origins of {3} and {4}
chosen at the base of the parallel jaw gripper.
3 chosen pointing upward (see Figure 17).
Directions of Z
Note: Actual SCARA manipulator has ball-screw at the
third joint We assume P joint.
D-H Table for SCARA robot
i i1 ai1
1
0
0
2
0
a1
3
0
a2
4
0
0
di
0
0
d3
0
i
1
2
0
4
NPTEL, 2010
58 / 138
SCARA
M ANIPULATOR
L INK
TRANSFORMS
Using equation (10) and the D-H table, link transforms can be
obtainedas
c1 s1 0 0
c2 s2 0 a1
c1 0 0
0 [T ] = s1
, 1 [T ] = s2 c2 0 0
1
0
0
0 1 0 2
0 1 0
0
0 0 1
0
0 0 1
1 0 0 a2
c4 s4 0 0
0
2 [T ] = 0 1 0
, 3 [T ] = s4 c4 0 0
3
4
0 0 1 d3
0
0 1 0
0 0 0
1
0
0 0 1
The transformation matrix 04
[T ] is
c124 0 a1 s1 + a2 s12
0 [T ] = 0 [T ]1 [T ]2 [T ] 3 [T ] = s124
4
1
2
3
4
0
0
1
d3
0
0
0
1
.
NPTEL, 2010
59 / 138
PARALLEL M ANIPULATORS
NPTEL, 2010
60 / 138
Link 2
l2
{L}
Break 4-bar
mechanism into two
serial manipulators.
L
Y
l1
Link 3
Link 1
l3
R
Y
{R}
1
L
X
l0
R
X
OR
OL
Break at joint 3
A 2R planar
manipulator + a 1R
manipulator
NPTEL, 2010
61 / 138
4- BAR
M ECHANISM
D-H
PARAMETERS
i1 ai1
0
0
0
l1
For 1R planar manipulator D-H
to {R}
i i1 ai1
1
0
0
i
1
2
i
1
2
parameters with respect
di
0
0
i
1
di
0
NPTEL, 2010
62 / 138
Moving Platform
S2
S3
l2
S1
l3
2
l1
Axis of R2
3
{Base}
O
Y
1
Base Platform
Axis of R3
Axis of R1
NPTEL, 2010
63 / 138
T HREE DOF
PARAMETERS
E XAMPLE :
D-H
i1 ai1 di i
0
0
0 1
/2
0
l1 0
D-H parameter for all R-P-S leg same except the reference
coordinate system.
{L1 }, {L2 }, and {L3 } are at the three rotary joints R1 , R2 ,
and R3 , respectively.
{Base} is located at the centre of the base platform &
Base [T ], i = 1, 2, 3, are constant and known.
Li
Note: The angle 1 shown in figure is same as /2 1 .
i
1
2
NPTEL, 2010
64 / 138
T HREE
DOF
E XAMPLE :
L INK
TRANSFORMATION MATRICES
c1
s1
L1
1 [T ] = 0
0
s1
c1
0
0
0
0
1
0
0
0
,
0
1
1 [T ] = 0
2
0
0
0
0
1
0
0
l1
0
1
0
1
0
0
Base [T ]
S1
L1
1
2
= Base
L1 [T ]1 [T ]2 [T ]S1 [T ]
Base [T ] Base S
1
S1
distance of R1
Location of S2 and S3
Base S
= ( b2 + 12 l3 cos 3 ,
3b
2
3l3
2
.
cos 3 , l3 sin 3 )T
.
NPTEL, 2010
65 / 138
PARALLEL M ANIPULATORS :
DOF E XAMPLE
Moving platform
connected to fixed base
by three chains.
Z
2
d
d
b2
l23
l22
l11
b1
l 21
l12
1
l13
p2
s
l33
b3
l 31
l32
3
X
p1
S IX
p3
Model of a
three-fingered hand
(Salisbury, 1982)
gripping an object with
point contact and
no-slip.
Each finger modeled
with R-R-R joints and
point of contact
modeled as S joint.
.
NPTEL, 2010
66 / 138
S IX
DOF
PARAMETERS
E XAMPLE :
AND
LINK
D-H
TRANS -
FORMS
D-H parameters for R-R-R chain.
i i1 ai1
1
0
0
2 /2
l11
3
0
l12
i
1
1
1
D-H parameter does not contain last link length l13 .
D-H parameters for three fingers with respect to
{Fi }, i = 1, 2, 3 identical.
Can obtain transformation matrix Fpii [T ] by matrix
multiplication.
di
0
0
0
NPTEL, 2010
67 / 138
S IX
DOF
E XAMPLE :
TRANSFORMS (C ONTD .)
L INK
NPTEL, 2010
68 / 138
S IX
DOF
E XAMPLE :
TRANSFORMS (C ONTD .)
L INK
second leg
cos 2 (l21 + l22 cos 2 + l23 cos(2 + 2 ))
Base p = d + sin (l + l cos + l cos( + ))
2 21
22
2
23
2
2
2
h + l22 sin 2 + l23 sin(2 + 2 )
For third
leg
Base p
3
NPTEL, 2010
69 / 138
S UMMARY
NPTEL, 2010
70 / 138
O UTLINE
.
. .1 C ONTENTS
.
. .2 L ECTURE 1
Mathematical Preliminaries
Homogeneous Transformation
..3 L ECTURE 2
.
Elements of a robot Joints
Elements of a robot Links
..4 L ECTURE 3
.
Examples of D-H Parameters & Link Transformation
Matrices
. L ECTURE 4
.
5
.
Elements of a robot Actuators & Transmission
..6 L ECTURE 5
.
Elements of a robot Sensors
..7 A DDITIONAL M ATERIAL
.
Problems, References, and Suggested Reading
.
NPTEL, 2010
71 / 138
NPTEL, 2010
72 / 138
Source: http://www.hocdelam.org/vn/category/ho-tro/robotandcontrol/
NPTEL, 2010
73 / 138
ACTUATORS
H YDRAULIC
FOR
ROBOTS
NPTEL, 2010
74 / 138
ACTUATORS
P NEUMATIC
FOR
ROBOTS
NPTEL, 2010
75 / 138
C OMPARISON OF P NEUMATIC
H YDRAULIC ACTUATORS
&
NPTEL, 2010
76 / 138
ACTUATORS
FOR
E LECTRIC M OTORS
ROBOTS
NPTEL, 2010
77 / 138
NPTEL, 2010
78 / 138
S TEPPER M OTORS
http://www.societyofrobots.com/member_tutorials/node/28
Permanent Magnet (PM) Stepper Motors Similar to VR but rotor is radially magnetized.
Hybrid Stepper Motors Combines best features of VR and PM stepper motors.
NPTEL, 2010
79 / 138
S TEPPER M OTORS
Typically stepper motors have two phases.
Four stepping modes
Wave drive Only one phase/winding is on/energized
Torque output is smaller.
Full step drive Both phases are on at the same time
Rated performance.
Half step drive Combine wave and full-step drive
Angular movement half of first two.
Micro-stepping Current is varying continuously
Smaller than 1.8 or 0.9 degree step size, lower torque.
NPTEL, 2010
80 / 138
NPTEL, 2010
81 / 138
DC S ERVO M OTORS
http://www.brushlessdcmotorparts.info http://www.rc-book.com/wiki
/brushless-electric-motor
NPTEL, 2010
82 / 138
M ODEL
OF
DC
PERMANENT
MAGNET MOTOR
Rotor is a
permanent magnet.
La
Ra
Stator Armature
coil with resistance
Ra and inductance
La .
ia
Va
Motor
Applied voltage Va ,
ia current in coil.
Rotation speed of
motor m
Figure 24: Model of a permanent magnet DC
servo-motor
Mechanical part.
Torque developed Tm = Kt ia Kt is constant.
Back-emf V = Kg m Kg is constant.
Motor dynamics can be modeled as first-order ODE
La ia + Ra ia + Kg m = Va
.
.
.
.
.
Mechatronic model Mechanical + Electrical/Electronics
NPTEL, 2010
83 / 138
Motor OFF
Forward direction
Reverse direction
Not Allowed
NPTEL, 2010
84 / 138
NPTEL, 2010
85 / 138
NPTEL, 2010
86 / 138
NPTEL, 2010
87 / 138
O UTLINE
.
. .1 C ONTENTS
.
. .2 L ECTURE 1
Mathematical Preliminaries
Homogeneous Transformation
..3 L ECTURE 2
.
Elements of a robot Joints
Elements of a robot Links
..4 L ECTURE 3
.
Examples of D-H Parameters & Link Transformation
Matrices
. L ECTURE 4
.
5
.
Elements of a robot Actuators & Transmission
..6 L ECTURE 5
.
Elements of a robot Sensors
..7 A DDITIONAL M ATERIAL
.
Problems, References, and Suggested Reading
.
NPTEL, 2010
88 / 138
I NTRODUCTION
A robot without sensors is like a human being without eyes,
ears, sense of touch, etc.
Sensor-less robots require costly/time consuming
programming.
Can perform only in playback mode.
No change in their environment, tooling and work piece
can be accounted for.
NPTEL, 2010
89 / 138
I NTRODUCTION (C ONTD .)
Dynamical system
Changes with time Governed by differential equations.
For a given input there is a well defined output.
Linear dynamical system Modeled by linear ordinary
differential equations Can be analysed using Laplace
transforms and transfer function5 .
NPTEL, 2010
90 / 138
NPTEL, 2010
91 / 138
Y (s) =
D(s)G (s)
R(s); Chosen D(s)G (s) >> 1
1 + D(s)G (s)
NPTEL, 2010
92 / 138
D(s)G (s)
(R(s)N(s)); ChosenD(s)G (s) >> 1
1 + D(s)G (s)
NPTEL, 2010
93 / 138
S ENSORS IN ROBOTS
Sensor is a device to make a measurement of a physical
variable of interest and convert it into electrical signal.
Desirable features in sensors are
High accuracy.
High precision.
Linear response.
Large operating range.
Low response time.
Easy to calibrate.
Reliable and rugged.
Low cost
Ease of operation
NPTEL, 2010
94 / 138
Force/torque sensors.
At joint actuators for control.
At wrist to measure components of force/moment being
applied on environment.
At end-effector to measure applied force on gripped object.
.
NPTEL, 2010
95 / 138
NPTEL, 2010
96 / 138
S ENSORS IN ROBOTS
How to compute resolution of a sensor?
Example: Optical encoder to measure joint rotation
97 / 138
O PTICAL E NCODER
NPTEL, 2010
98 / 138
O PTICAL E NCODER
NPTEL, 2010
99 / 138
NPTEL, 2010
100 / 138
NPTEL, 2010
101 / 138
NPTEL, 2010
102 / 138
F = [RF ]W
wherea
RF =
0
r12
0
r61
0
0
r32
0
r52
0
r13
0
0
0
0
r63
0
0
r34
r44
0
0
0
r25
0
0
0
r65
0
0
r36
0
r56
0
0
0
r38
r48
0
0
r17
0
0
0
0
r67
F = (Fx , Fy , Fz , Mx , My , Mz )T .
W = (w1 , w2 , w3 , w4 , w5 , w6 , w7 , w8 ).
wi are the 8 strain gauge readings.
Figure 33: Six axis
force/torque sensors at wrist
NPTEL, 2010
103 / 138
Simple LED-Photo-diode
pair used to detect
presence/absence of object
to be grasped
Micro-switch to detect
touch.
NPTEL, 2010
104 / 138
NPTEL, 2010
105 / 138
NPTEL, 2010
106 / 138
E XTERNAL
(C ONTD .)
S ENSORS
TACTILE
Send current in one set,
measure current in other
set
Magnitude of current
change in resistance due to
deformation
Magnitude of current
change in capacitance
NPTEL, 2010
107 / 138
NPTEL, 2010
108 / 138
NPTEL, 2010
109 / 138
NPTEL, 2010
110 / 138
NPTEL, 2010
111 / 138
I NDUCTIVE
H ALL
P ROXIMITY S ENSOR
E FFECT
NPTEL, 2010
112 / 138
NPTEL, 2010
113 / 138
NPTEL, 2010
114 / 138
NPTEL, 2010
115 / 138
NPTEL, 2010
116 / 138
R ANGE S ENSORS
Measure distance of objects at larger distances.
Uses electromagnetic or electrostatic or acoustic radiation
Looks for changes in the field or return signal.
Highly reliable with long functional life and no mechanical
parts.
Four main kinds of range sensing techniques in robots
Triangulation.
Structured lighting approach.
Time of flight range finders.
Vision .
NPTEL, 2010
117 / 138
NPTEL, 2010
118 / 138
NPTEL, 2010
119 / 138
NPTEL, 2010
120 / 138
ct
2
NPTEL, 2010
121 / 138
, is the
D = L + 360
phase shift.
.
NPTEL, 2010
122 / 138
( )
360 2
NPTEL, 2010
123 / 138
NPTEL, 2010
124 / 138
V ISION S ENSORS
Most powerful and complex form of sensing, analogous to
human eyes.
Comprising of one or more video cameras with integrated
signal processing and imaging electronics.
Includes interfaces for programming and data output, and a
variety of measurement and inspection functions.
Also referred to as machine or computer vision.
Computations required are very large compared to any
other form of sensing.
Computer vision can be sub-divided into six main areas: 1)
Sensing, 2) Pre-processing, 3) Segmentation, 4)
Description, 5) Recognition and 6) Interpretation.
NPTEL, 2010
125 / 138
V ISION S ENSORS
Three levels of processing.
Low level vision
Primitive in nature, requires no intelligence on the part of
the vision functions.
Sensing and pre-processing can be considered as low level
vision functions.
NPTEL, 2010
126 / 138
V ISION S ENSORS
Smaller number of robotic applications Primarily due to
computational complexity and low speed.
Vision system can
Determine distances of objects.
Determine geometrical shape and size of objects.
Determine optical (color, brightness) properties of objects
in an environment.
Can be used for navigation (map making), obstacle
avoidance, Cartesian position and velocity feedback,
locating parts, and many other uses.
Can learn about environment.
Acquire knowledge and intelligence.
NPTEL, 2010
127 / 138
N EW D EVELOPEMENTS IN S ENSOR
T ECHNOLOGY MEMS S ENSORS
Consist of very small electrical, electronics and mechanical
components integrated on a single chip.
Provide an interface to sense, process and/or control the
surrounding environment.
Generally silicon based, allowing integration with
microelectronics.
Sensing mechanisms employed are a) Capacitive, b)
Piezoelectric, c) Piezoresistive, d) Ferroelectric, e)
Electromagnetic and f) Optical.
Capacitive sensing most successful due to a) No
requirement of exotic materials, b) Low power consumption
and c) Stability over temperature ranges.
.
NPTEL, 2010
128 / 138
NPTEL, 2010
129 / 138
NPTEL, 2010
130 / 138
MOEMS S ENSORS
NPTEL, 2010
131 / 138
S MART S ENSORS
NPTEL, 2010
132 / 138
NPTEL, 2010
133 / 138
I NTELLIGENT S ENSORS
NPTEL, 2010
134 / 138
Intelligence
Charting a shortest route.
Recognizing moving objects.
Distinguish sounds and recognize
faces and gestures.
NPTEL, 2010
135 / 138
NPTEL, 2010
136 / 138
O UTLINE
.
. .1 C ONTENTS
.
. .2 L ECTURE 1
Mathematical Preliminaries
Homogeneous Transformation
..3 L ECTURE 2
.
Elements of a robot Joints
Elements of a robot Links
..4 L ECTURE 3
.
Examples of D-H Parameters & Link Transformation
Matrices
. L ECTURE 4
.
5
.
Elements of a robot Actuators & Transmission
..6 L ECTURE 5
.
Elements of a robot Sensors
..7 A DDITIONAL M ATERIAL
.
Problems, References, and Suggested Reading
.
NPTEL, 2010
137 / 138
A DDITIONAL MATERIAL
Exercise Problems
References & Suggested Reading
Homogeneous coordinates, lines & screws
NPTEL, 2010
138 / 138