Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
Outline
Design of Robot Manipulators
Kinematics
Degrees of Freedom
Types of Kinematics
Homogeneous Transformations
Geometric Approach
Forward and Inverse Kinematics of Planar and Spatial Robots
Case Studies
20-12-2010
20-12-2010
The space within which the robot can manipulate its wrist end is known as work
volume.This avoids the complication of different sizes of end effectors that might
be attached to robots wrist.This is determined by the following physical
characteristics
of the
robot. configuration, Size of the body,arm and
Robots
Physical
wrist components,The limits of robots joint movement
CONFIGURATION
Jointed arm
Cylindrical
Cartesian
Polar
SCARA
Payload
Plays a vital role in the design of manipulators
It is the load carried by the robot at the wrist
end of the robot when its arm is fully
stretched or fully extended
It includes the end effector weight also
The Payload to Weight ratio should be in the
ratio of 1:200
20-12-2010
Inertia force
Another important parameter influencing the
design & performance of robot
Depends upon the payload,speed and
acceleration of the robot while in motion
It always acts in the direction opposite to that
of the motion of the manipulator
20-12-2010
Centre of Gravity
It is the point where the entire weight of the
robot is said to be concentrated
Plays a important role in the design of
manipulators especially in Bipedal robots,
humanoid robots and articulated robots
Depends upon the weight of the links,
actuators, joints, transmission elements and
payload
20-12-2010
Speed
It is defined as how quickly the robot will
move from one position to the next
Higher speed affects the stability of the robot
Pneumatic actuators give maximum speed
compared to hydraulic and electrical actuators
20-12-2010
Dynamics
Kinematics
10
Planar
The robots configured in such a way that the
workspace of the robot is limited to a plane are called
as planar robots
Spatial Robots
The robots whose end effector has access to any point
in space (of course limited to the work volume)
20-12-2010
11
Degrees of freedom
20-12-2010
12
Degrees of freedom
Positioning
Positioning the end effector in the 3D space, requires three DoF,
either obtained from rotations or translations
Reference
frame origin
x
y
20-12-2010
13
Degrees of freedom
Orientation
Orienting the end effector in the 3D space, requires three additional
DoF to produce the three rotations.
roll
tilt
pan
Reference
frame origin
x
y
20-12-2010
14
Basic Joints
Rotational Joint
1 DOF
Prismatic
Joint
1 DOF
(linear)
Twist Joint
1 DOF
3 DOF
20-12-2010
Revolving
Joint
1 DOF
15
20-12-2010
16
17
Types of Kinematics
20-12-2010
18
19
Homogenous Transformation
A matrix H will be considered such that an operator which
AICTE Sponsored SDP
Y=HX
If Y is a 4x1 column matrix and H, a 4x4 column matrix and 4x1
column matrix then y is obtained by pre-multiplying the X column
matrix by a 4x4 transformation matrix H.
20-12-2010
20
Translation
H
0 0 1 c
Trans (a, b, c)
=
0 0 0 1
20-12-2010
21
Rotation Matrices in 3D
Homogeneous Representation
AICTE Sponsored SDP
22
Homogenous Transformation in 3D
0 0 0 1
Y
N
P
A
X
Translation without
rotation
N
X
Z
20-12-2010
Rotation without
translation INDUSTRIAL ROBOTICS -
Rotation part:
Could be rotation around z-axis, x-axis,
y-axis or a combination of the three.
n x
n
H y
n z
ox
oy
ax
ay
oz
0
az
0
0
0
0
1
23
the Robot
20-12-2010
24
Forward Kinematics
The Situation:
You have a robotic arm that starts out
with the xo-axis.
You tell the first link to move by
the second link to move by 2.
aligned
1 and
The Quest:
end of the
Solution:
Geometric Approach
This might be the easiest solution for the simple situation. However, notice
that the angles are measured relative to the direction of the previous link.
(The first link is the exception. The angle is measured relative to its initial
position.) For robots with more links and whose arm extends into 3
dimensions the geometry gets much more tedious.
Algebraic Approach
Involves coordinate transformations.
20-12-2010
26
Cartesian Co ordinate
There are 3 linear movements along the 3
major axes (X,Y,Z)
Positioning of the hand of the robot is
accomplished by moving the 3 linear joints
along the 3 axes
The transformation matrix representing the
motion to a point P is a simple Translational
transformation matrix since there are no
rotations
Cartesian Co ordinate
o
z
a
P
Pz
y
Px
Py
X
RT =
P
CYLINDRICAL CO ORDINATES
The total transformation caused by the three transformation that relates the origin of hand
frame to the reference frame is obtained as,
RT
p = T cyl ( r,,l) = Trans (0,0,l) Rot ( Z, ) Trans (r,0,0)
C S 0 rC
RT
S C 0 rS
p=
CYLINDRICAL CO ORDINATES
n
a
P
l
SPHERICAL CO-ORDINATES
The sequence is ,
RT
p=
SPHERICAL CO-ORDINATES
SPHERICAL CO-ORDINATES
RTp =
First three columns represents the orientation of the frame and last column
Represent the position of the origin.
36
x = L . cos
y = L . Sin
= Angle of
Rotation
(x, y)
Inverse Kinematics
L . sin
=
20-12-2010
tan-1(y/x)
x
L . cos
37
y = L1 . sin1 + L2 . sin(1+ 2)
L2 . sin(1+ 2)
x = L1 . cos1 + L2 . cos(1+ 2)
(x, y)
L1 .
sin1
1
x
L1 .
cos1
20-12-2010
L2 . cos(1+ 2)
38
INVERSE KINEMATICS
Position of end of arm in world
space in link vectors
20-12-2010
39
20-12-2010
40
Also
20-12-2010
41
equations of the TR
robot configuration are
X = [L1 cos] cos
Y = L1 sin
Z = [L1 cos] sin
X, Y, Z
z
20-12-2010
Inverse Kinematics
Tan = (Z/X)
Sin = (Y/ L)
42
20-12-2010
43
20-12-2010
44
90 -
L1 sin
X, Y, Z
x
z
20-12-2010
45
20-12-2010
46
20-12-2010
47
48
The Denavit-Hartenberg
Transformation
In 1955 Denavit and Hartenberg published a paper in ASME journal
AICTE Sponsored SDP
which was later used to represent and model robots and to derive
their equations of motion.
The method can be used for any robot configuration, regardless of
20-12-2010
49
D-H Representation
20-12-2010
50
D-H Representation
Rotate about the z-axis an angle of n+1. This will make xn and xn+1
parallel to each other. This is true because an and an+1 are both
perpendicular to zn and rotating zn an angle of n+1 will make them
parallel (and thus coplanar)
20-12-2010
51
D-H Representation
Translate along the zn-axis a distance of dn+1 to make xn and
20-12-2010
52
D-H Representation
Translate along the xn-axis a distance of an+1 to
bring the origins of xn and xn+1 together. At this
AICTE Sponsored SDP
20-12-2010
53
D-H Representation
Rotate zn-axis about xn+1 axis an angle of
n+1 to align zn-axis with zn+1-axis. At this
AICTE Sponsored SDP
20-12-2010
54
D-H Representation
20-12-2010
55
An 1
0
Sn 1
Cn 1
dn 1
0
0
0
1
20-12-2010
56
D-H Representation
So in general once we know the individual
transformations, the total transformation
between the base of the robot and the hand will
be
57
Configuration
X, Y, Forward
1
L1
L1
An 1
0
Sn 1
Cn 1
dn 1
0
0
0
1
20-12-2010
C1 S 1
S 1 C1
A1
0
0
0
0
0 C1L1
0 S 1L1
1
0
0
1
58
L11
L22
(x, y)
C1 S 1
S 1 C1
A1
0
0
0
0
0 C1L1
0 S 1L1
1
0
0
1
C 2 S 2
S 2 C2
A2
0
0
0
0
0 C 2 L 2
0 S 2 L 2
1
0
0
1
20-12-2010
1
x
59
(C1C 2 S 1S 2) (C1S 2 S 1C 2)
( S 1C 2 C1S 2) ( S 1S 2 C1C 2)
A1 A2
0
0
0
0
0 (C1C 2 L 2 S 1S 2 L 2 C1L1)
0 ( S 1C 2 L 2 C1S 2 L 2 S 1L1)
1
0
0
1
n x
n
H y
n z
ox
ax
oy
ay
oz
az
Px
Py
Pz
60
Frame Assignments
20-12-2010
61
An 1
0
Sn 1
Cn 1
dn 1
0
0
0
1
20-12-2010
62
x3
D-H Parameters
20-12-2010
63
C 1
S1
A1
0
S1
0 C1
0
0
C 2 S 2
S 2 C2
0
A2
0
0
0
1
0
0
0 C 2 L1
C 3 S 3
S 3 C3
0 S 2 L1
A3
0
0
1
0
0
0
1
0
0 C 3 L 2
0 S 3 L 2
1
0
0
1
A1 A2
S2
C2
0
S 2 L1
0
0
0
1
A1 A2 A3
S2
C2
0
S 2 L1
0
0
0
1
C 3 S 3
S 3 C3
0
0
0
0
0 C 3 L 2
0 S 3 L 2
1
0
0
1
64
A1 A2 A3
( S 2C 3 C 2 S 3)
( S 2 S 3 C 2C 3)
0
( S 2C 3 L 2 C 2 S 3 L 2 S 2 L1)
0
0
0
1
n x
The above matrix is in the form n y
H
n z
ox
ax
oy
ay
oz
az
Px
Py
Pz
20-12-2010
65
20-12-2010
66
Frame Assignments
20-12-2010
67
D-H Parameters
20-12-2010
68
Transformation Matrices
20-12-2010
69
D-H Representation
70
Matrix Inversion
71
Consider
1
Rot (x, ) 0
0
0
cos
sin
sin
cos
0
20-12-2010
cos
sin
sin
cos
72
20-12-2010
73
20-12-2010
74
20-12-2010
75
20-12-2010
76
20-12-2010
L1
L2
ny
H
n z
oy
ay
oz
az
Py
Pz
77
C1 S 1
S 1 C1
A1
0
0
0
0
C 2 S 2
S 2 C2
A2
0
0
0
0
0 C1L1
0 S 1L1
1
0
0
1
(C1C 2 S 1S 2) (C1S 2 S 1C 2)
( S 1C 2 C1S 2) ( S 1S 2 C1C 2)
A1 A2
0
0
0
0
0 C 2 L 2
0 S 2 L 2
1
0
0
1
0 (C1C 2 L 2 S 1S 2 L 2 C1L1)
0 ( S 1C 2 L 2 C1S 2 L 2 S 1L1)
1
0
0
1
To solve for the angles we will successfully premultiply the two matrices starting with
A1-1
A1-1
20-12-2010
n x
n
y
n z
ox
ax
oy
ay
oz
az
Px
Py
Pz
(A1-1) (A1A2)
A2
78
To find A1-1
C1 S 1
S 1 C1
AT
0
0
0
0
0 C1L1
0 S 1L1
1
0
0
1
20-12-2010
n x
o
1
H
x
a x
ny
nz
oy
oz
ay
az
C1 S 1
S 1 C1
A1
0
0
0
0
P.n
P.o
P.a
0 L1
0 0
1 0
0 1
79
C1 S 1
S 1 C1
0
0
0
0
0 L1
0 0
1 0
0 1
n x
n
y
n z
ox
ax
oy
ay
oz
az
Px
Py
Pz
C 2 S 2
S 2 C2
0
0
0
0
0 C 2 L 2
0 S 2 L 2
1
0
0
1
nz
oz
az
Pz
0
0
0
1
80
axC1+ayS1=0
-axS1+ayC1=0
nxC1+nyS1=C2
oxC1+oyS1= -S2
PxC1+PyS1-L1=C2L2
-PxS1+PyC1=S2L2
-nxS1+nyC1=S2
-oxS1+oyC1=C2
Pz=0
az=1
20-12-2010
(1)
(2)
(3)
(4)
(5)
(6)
(7)
(8)
(9)
(10)
81
To
Find
The
value
of
theta
2
Concider eqn no. (5)& eqn. no (6)
PxC1+PyS1-L1=C2L2 (5)
(PxC1+PyS1) = (C2L2-L1)
(A)
( -PxS1+PyC1)=S2L2
(B)
Squaring both sides and adding eqn (A)& (B)
(PxC1+PyS1)2 = (C2L2-L1)2
( -PxS1+PxC1) 2 = (S2L2) 2
Px2 +Py2 = L12 + L22 +2L1L2C2
From the above equation
C2 =
20-12-2010
82
(A)
(B)
(X)
83
From eqn.(6)
( -PxS1+PyC1)=S2L2
C1= (S2L2+PxS1) / Py
(y)
Comparing (x) & (y)
(S2L2+PxS1) / Py =( -C2 L2S1 +Py- L1S1) / S2L2
By solving the set of equations Theta 1 can be calculated as
20-12-2010
84