Robotics Latest
Robotics Latest
(Autonomous)
Dundigal, Hyderabad - 500 043
1
UNIT-I
2
Introduction to Robotics
3
• Introduction to Robotics
• Classification of Robots
• Robot coordinates
• Work volumes and Reference Frames
• Robot Applications.
4
Automation vs. robots
6
Robotics Terminology
Robot - Mechanical device that performs
human tasks, either automatically or by
remote control.
Robotics - Study and application of robot
technology.
Telerobotics - Robot that is operated
remotely.
7
Laws of Robotics
Asimov proposed three “Laws of Robotics”
8
Ideal Tasks
Tasks which are:
– Dangerous
• Space exploration
• chemical spill cleanup
• disarming bombs
• disaster cleanup
– Boring and/or repetitive
• Welding car frames
• part pick and place
• manufacturing parts.
– High precision or high speed
• Electronics testing
• Surgery
• precision machining.
9
Robotics Timeline
• 1922 Czech author Karel Capek wrote a story called
Rossum’s Universal Robots and introduced the word
“Rabota”(meaning worker)
• 1954 George Devol developed the first programmable
Robot.
• 1955 Denavit and Hartenberg developed the
homogenous transformation matrices
• 1962 Unimation was formed, first industrial Robots
appeared.
• 1973 Cincinnati Milacron introduced the T3 model robot,
which became very popular in industry.
• 1990 Cincinnati Milacron was acquired by ABB
10
ROBOT
• Defined by Robotics Industry Association
(RIA) as
– a re-programmable, multifunctional manipulator
designed to move material, parts, tools or
specialized devices through variable programmed
motion for a variety of tasks
• possess certain anthropomorphic
characteristics
– mechanical arm
– sensors to respond to input
– Intelligence to make decisions
11
Accessories
13
Cartesian Robot - Work
Envelope
14
Robot Configurations
• Cylindrical (R2P): Cylindrical coordinate Robots have 2 prismatic
joints and one revolute joint.
15
Cylindrical Robot - Work
Envelope
16
Robot Configurations
• Spherical joint (2RP): They follow a spherical coordinate system,
which has one
17
Spherical Robot - Work
Envelope
18
Robot Configurations
• Articulated/anthropomorphic(3R) :An articulated robot’s joints are
all revolute, similar to a human’s arm.
19
Robot Configurations
• Selective Compliance Assembly Robot Arm (SCARA) (2R1P):
They have two revolute joints that are parallel and allow the Robot to
move in a horizontal plane, plus an additional prismatic joint that
moves vertically
20
Robot Configurations
21
Work Envelope concept
• Depending on the configuration and size of the
links and wrist joints, robots can reach a
collection of points called a Workspace.
22
Pure Spherical Jointed Arm - Work
envelope
23
2) Parallelogram Jointed
24
WRIST
• typically has 3 degrees of freedom
– Roll involves rotating the wrist about the arm
axis
– Pitch up-down rotation of the wrist
– Yaw left-right rotation of the wrist
• End effector is mounted on the wrist
25
WRIST MOTIONS
26
CONTROL METHODS
• Non Servo Control
– implemented by setting limits or mechanical
stops for each joint and sequencing the
actuation of each joint to accomplish the cycle
– end point robot, limited sequence robot, bang-
bang robot
– No control over the motion at the intermediate
points, only end points are known
27
• Programming accomplished by
– setting desired sequence of moves
– adjusting end stops for each axis accordingly
– the sequence of moves is controlled by a
“squencer”, which uses feedback received from
the end stops to index to next step in the program
• Low cost and easy to maintain, reliable
• relatively high speed
• repeatability of up to 0.01 inch
• limited flexibility
• typically hydraulic, pneumatic drives
28
• Servo Control
– Point to point Control
– Continuous Path Control
• Closed Loop control used to monitor
position, velocity (other variables) of
each joint
29
Point-to-Point Control
• Only the end points are programmed, the
path used to connect the end points are
computed by the controller
• user can control velocity, and may permit
linear or piece wise linear motion
• Feedback control is used during motion to
ascertain that individual joints have
achieved desired location
30
• Often used hydraulic drives, recent trend
towards servomotors
• loads up to 500lb and large reach
• Applications
– pick and place type operations
– palletizing
– machine loading
31
Continuous Path Controlled
• in addition to the control over the
endpoints, the path taken by the end
effector can be controlled
• Path is controlled by manipulating the
joints throughout the entire motion, via
closed loop control
• Applications:
– spray painting, polishing, grinding, arc welding
32
ROBOT PROGRAMMING
• Typically performed using one of the
following
– On line
• teach pendant
• lead through programming
– Off line
• robot programming languages
• task level programming
33
Use of Teach Pendant
• hand held device with switches used to
control the robot motions
• End points are recorded in controller
memory
• sequentially played back to execute robot
actions
• trajectory determined by robot controller
• suited for point to point control applications
34
• Easy to use, no special programming skills
required
• Useful when programming robots for wide
range of repetitive tasks for long
production runs
• RAPID
35
Lead Through Programming
• lead the robot physically through the
required sequence of motions
• trajectory and endpoints are recorded,
using a sampling routine which records
points at 60-80 times a second
• when played back results in a smooth
continuous motion
• large memory requirements
36
Programming Languages
• Motivation
– need to interface robot control system to
external sensors, to provide “real time”
changes based on sensory equipment
– computing based on geometry of environment
– ability to interface with CAD/CAM systems
– meaningful task descriptions
– off-line programming capability
37
• Large number of robot languages
available
– AML, VAL, AL, RAIL, RobotStudio, etc. (200+)
• Each robot manufacturer has their own
robot programming language
• No standards exist
• Portability of programs virtually non-
existent
38
Sensory
• Uses sensors for feedback.
• Resolution
– Often a speed tradeoff
– The smallest step the robot can take
40
Performance
• Accuracy
–The difference between the
actual position of the robot and
the programmed position
• Repeatability
Will the robot always return to the
same point under the same
control conditions?
Increased cost
41
Control
42
Actuators
• Actuator is the term used for the mechanism that
drives the robotic arm.
• There are 3 main types of Actuators
1. Electric motors
2. Hydraulic
3. Pneumatic cylinder
• Hydraulic and pneumatic actuators are generally
suited to driving prismatic joints since they produce
linear motion directly
• Hydraulic and pneumatic actuators are also known as
linear actuators.
• Electric motors are more suited to driving revolute
joints as they produce rotation
43
Hydraulic Actuators
• A car makes use of a hydraulic system. If we look at the braking
system of the car we see that only moderate force applied to the
brake pedal is sufficient to produce force large enough to stop the
car.
• The underlying principle of all hydraulic systems was first
discovered by the French scientist Blaise Pascal in 1653. He stated
that “if external pressure is applied to a confined fluid, then the
pressure is transferred without loss to all surfaces in contact with
the fluid”
• The word fluid can mean both a gas or a liquid
• Where large forces are required we can expect to find hydraulic
devices (mechanical diggers on building sites, pit props in coal
mines and jacks for lifting cars all use the principle of hydraulics.
44
Hydraulic Actuators
• Each hydraulic actuator contains the following parts:
1. Pistons
2. Spring return piston
3. Double acting cylinder
4. Hydraulic transfer value
5. And in some cases a hydraulic accumulator
• Advantages of the hydraulic mechanism
1. A hydraulic device can produce an enormous range of forces without the
need for gears, simply by controlling the flow of fluid
2. Movement of the piston can be smooth and fast
3. Position of the piston can be controlled precisely by a low-current
electrically operated value
4. There are no sparks to worry about as there are with electrical motor, so the
system is safe to use in explosive atmospheres such as in paint spraying or
near inflammable materials
45
Pneumatic Actuators
• A pneumatic actuator uses air instead of fluid
• The relationship between force and area is the same in a
pneumatic system compared to a hydraulic system
• We know that air is compressible, so in order to build up
the pressure required to operate the piston, extra work
has to be done by the pump to compress the air. This
means that pneumatic devices are less efficient
• If you have ever used a bicycle pump you may have
noticed that it becomes hot as it is used. The heat
produced by the mechanical work done in compressing
the air. Heat represents wasted energy.
46
Pneumatic Actuators
• Advantages of the Pneumatic system:
1. Generally less expensive than an equivalent hydraulic system. Many factories
have compresses air available and one large compressor pump can serve several
robots
2. Small amount of air leakage is ok, but in a hydraulic system it will require prompt
attention
3. The compressibility of air can also be an advantage in some applications. Think
about a set of automatic doors which are operated pneumatically. If a person is
caught in the doors they will not be crushed.
4. A pressure relief valve can be incorporated to release pressure when a force is
exceeded, for example the gripper of a robot will incorporate a relief value to
ensure it does not damage itself or what it is gripping
5. Pneumatic devices are faster to respond compared to a hydraulic system as air is
lighter than fluid.
• A pneumatic system has its downfalls and the main one is that it can produce the
enormous forces a hydraulic system can. Another is concerned with the location of
the pistons. As air is compressible heavy loads on the robot arm may cause the
pistons to move even when all the valves on the cylinder are closed. It is for this
reason that pneumatic robots are best suited for pick and place robots.
47
Electric Motors
• Not all electric motors are suited for use as
actuators in robots
• There are three basic characteristics of a motor,
when combined will determine the suitability of a
motor for a particular job. The 3 characteristics
are power, torque and speed. Each of these
characteristics are interdependent, that means
that you can not alter one without affecting the
others.
48
Electric Motors
• Two types of power: electrical and mechanical, both are measured
in watts.
• Torque is how strong a motor is or how much turning force it is
able to produce and is measured in newton-metres.
• The speed is measured in revolutions per minute and is rotation of
the motor
• There are 3 different types of motors
1. AC motor which operates by alternating current electricity
2. DC motor which operates by direct current electricity
3. Stepper motors which operates by pulses of electricity
• Any type of electric motor could be used for a robot as long as it is
possible to electronically control the speed and power so that it
behaves the way we want.
• DC motors and Stepper motors are commonly used in robotics
49
Robot End effectors
•Introduction
•Types of End effectors
•Mechanical gripper
•Types of gripper mechanism
•Gripper force analysis
•Other types of gripper
•Special purpose grippers
50
Consider Typical Robots
What could a robot do without “end effectors”?
51
End effector
Device that attaches to the wrist of the robot arm and
enables the general-purpose robot to perform a specific
task.
Two types:
Grippers – to grasp and manipulate objects (e.g., parts)
during work cycle
52
Unilateral vs Multilateral Gripper
Unilateral– only one point or surface is touching the object
to be handled. (fig 1)
Example : vacuum pad gripper & Electro magnetic gripper
53
Gripper
End-effector that holds or grasp an object (in assembly, pick
and place operation and material handling) to perform
some task.
54
Mechanical Gripper
It is an end effector that uses mechanical fingers actuated by a
mechanism to grasp an object.
• Two ways of constraining part in gripper
1. Physical construction of parts within finger. Finger encloses the part
to some extent and thereby designing the contact surface of finger to be
in approximate shape of part geometry.
2. Holding the part is by friction between fingers and workpart. Finger
must apply force that is sufficient for friction to retain the part against
.
gravity
55
Mechanical Gripper
To resist the slippage, the gripper must be designed to exert a
force that depends on the weight of the part, coeff of friction
and acceleration of part.
56
Mechanical Gripper
57
Mechanical Gripper Mechanism
Two ways of gripper mechanism based on finger movement
[Link] movement – Eg. Link actuation
[Link] or translational movement – Eg. Screw and cylinder
58
Mechanical Gripper Mechanism
1. Linkage actuation
59
Mechanical Gripper Mechanism
2. Gear and rack actuation
60
Mechanical Gripper Mechanism
2. Gear and rack actuation
61
Mechanical Gripper Mechanism
2. Gear and rack actuation
62
Mechanical Gripper Mechanism
3. Cam actuation
63
Mechanical Gripper Mechanism
4. Screw actuation
64
Pneumatic or air operated Gripper
Equipped with roller membrane cylinder with a rolling
motion replacing conventional piston cylinder.
This motion is transmitted to fingers by means of lever
mechanism.
The grippers are actuated by switching valves in the circuit.
The finger stroke is limited by end stops or workpiece to be
gripped.
65
Gripper force analysis
66
2) Hooks and Scoops
Hooks and scoops are the simplest type of end effectors that can be
classes as grippers.
A scoop or ladle is commonly used to scoop up molten metal and
transfer it to the mould
A hook may be all that is needed to lift a part especially if precise
positioning in not required and if it is only to be dipped into a
liquid.
Hook are used to load and unload parts hanging from the overhead
conveyors. The parts to be handled by a hook must have some sort
of handle, eyebolt or ring to enable the hook to hold it.
Scoops are used for handling the materials in liquid or power from,
the limitation of scoop is, it is difficult to control the amount of
martial being handled by the scoop. In addition, spilling of the
material during handling is another problem. 67
Hooks and Scoops design
68
3) Magnetic Grippers
Magnetic grippers obviously only work on magnetic objects and therefore
are limited in working with
certain metals.
For maximum effect the magnet needs to have complete contact with the
surface of the metal to be gripped. Any air gaps will reduce the strength of
the magnetic force, therefore flat sheets of metal are best suited to magnetic
grippers.
If the magnet is strong enough, a magnetic gripper can pick up an irregular
shaped object. In some cases the shape of the magnet matches the shape of
the object
A disadvantage of using magnetic grippers is the temperature. Permanent
magnets tend to become demagnetized when heated and so there is the
danger that prolonged contact with a hot work piece will weaken them to
the point where they can no longer be used. The effect of heat will depend
on the time the magnet spends in contact with the hot part. Most magnetic
materials are relatively unaffected by temperatures up to around 100
degrees.
Electromagnets can be used instead and are operated by a DC electric
current and lose nearly all of
their magnetism when the power is turned off.
Permanent magnets are also used in situations where there is an explosive 69
atmosphere and sparks from electrical equipment would cause a hazard
Magnetic Grippers design 70
4) Suction Grippers
There are two types of suction grippers:
[Link] operated by a vacuum – the vacuum may be provided by a
vacuum pump or by compressed air
[Link] with a flexible suction cup – this cup presses on the work
piece. Compressed air is blown into the suction cup to release the
work piece. The advantage of the suction cup is that if there is a
power failure it will still work as the work piece will not fall down.
The disadvantage of the suction cup is that they only work on clean,
smooth surfaces.
There are many more advantages for using a suction cup rather
than a mechanical grip including: there is no danger of crushing
fragile objects, the exact shape and size does not matter and the
suction cup does not have to be precisely positioned on the object
The downfalls of suction cups as an end effector include: the robot
system must include a form of pump for air and the level of noise
can cause annoyance in some circumstances
71
Vacuum gripper
design
72
5) Expandable Bladder Type
Grippers
A bladder gripper or bladder hand is a specialized robotic end
effector that can be used to grasp, pick up, and move rod-
shaped or cylindrical objects.
The main element of the gripper is an inflatable, donut-shaped
or cylindrical sleeve that resembles the cuff commonly used in
blood pressure measuring apparatus.
The sleeve is positioned so it surrounds the object to be
gripped, and then the sleeve
is inflated until it is tight enough to accomplish the desired task.
The pressure exerted by the sleeve can be measured and
regulated using force sensors.
Bladder grippers are useful in handling fragile objects.
However, they do not operate fast, and they can function
only with objects within a rather narrow range of physical
sizes. 73
Expandable Bladder Type Grippers
74
6) Adhesive Grippers
75
Adhesive Grippers
Design
76
Types of Tools
• A common tool used as an end effector is the
welding tool. Welding is the process of joining
two pieces of metal by melting them at the join
and there are 3 main welding tools: a welding
torch, spot welding gun and a stud welding tool
• Other common tools are paints praying,
deburring tools, pneumatic tools such as a nut
runner to tighten nuts.
77
Issues in choosing actuators
• Load (e.g. torque to overcome own inertia)
• Speed (fast enough but not too fast)
• Accuracy (will it move to where you want?)
• Resolution (can you specify exactly where?)
• Repeatability (will it do this every time?)
• Reliability (mean time between failures)
• Power consumption (how to feed it)
• Energy supply & its weight
• Also have many possible trade-offs between
physical design and ability to control
78
UNIT-II
79
An Introduction to
Robot Kinematics
80
Kinematics studies the motion of bodies
81
An Example - The PUMA 560
2
3
4
1
There are two
more joints on the
end effector (the
The PUMA 560 has SIX revolute joints gripper)
A revolute joint has ONE degree of freedom ( 1 DOF) that is
defined by its angle
82
Other basic joints
Revolute Joint
1 DOF ( Variable - )
Prismatic Joint
1 DOF (linear) (Variables - d)
Spherical Joint
3 DOF ( Variables - 1, 2,
3)
83
We are interested in two kinematics topics
84
Quick Math Review
Dot Product: a x
Geometric Representation: a
y
b x
A B A B cos θ A
b
θ y
B
Matrix Representation:
a x b x
A B a xb x
a yb y
a b
y y
Unit Vector
Vector in the direction of a chosen vector but whose magnitude
is 1. B
uB
B B
uB
85
Quick Matrix Review
Matrix Multiplication:
An (m x n) matrix A and an (n x p) matrix B, can be multiplied
since the number of columns of A is equal to the number of rows of B.
Non-Commutative Multiplication
AB is NOT equal to BA
a b e f ae bg af bh
c d g h ce dg cf dh
Matrix Addition:
a b e f a e b f
c d g h c g d h
86
Basic Transformations
Moving Between Coordinate Frames
(VN,VO)
VO
P
N
X VN
Px
V V Px
X N
P
XY NO
Notation: V V
Y O
V V 0 87
Writing V
XY
in terms ofV NO
Y O
VO
P
N
X VN
PX V
N
P V
XY NO
V
O
V
88
O
Translation along the X-Axis and Y-Axis
VO
N
VN
Px
XY
X P
PY
PX V
N
P V
XY NO
V
PY V
O
89
Using Basis Vectors
Basis vectors are unit vectors that point along a coordinate
axis
O
VN N
n
V
N V NO cos θ V
NO
cos θ V
NO
n
NO
NO
O
V
NO NO
V V sin θ V cos(90 θ) V o
90
Y
Rotation (around the Z-Axis)
Z X
Y
VY
X
VX
V V
X N
XY NO
V
Y V
O
V V 91
Y
Unit vector along X-Axis
Can be considered with respect to
the XY coordinates or NO coordinates
V
XY NO
V V
VY
X
VX
cos α cos α V x
X XY NO NO
V V V
(Substituting for VNO using the N and O
(V n V o) x
X N O
V components of the vector)
V (x n ) V (x o )
X N O
V
V (cos θ ) V
N O
(sin θ )
92
Similarly….
sin α α) V y
Y NO NO NO
V V V cos(90
(V n V o) y
Y N O
V
V (y n ) V (y o )
Y N O
V
V θ)) V
N O
(cos(90 (cos θ )
V (sin θ ) V
N O
(cos θ )
So….
V
X
V (cos θ ) V
X N O
V (sin θ ) XY
V
Y
V
Y
V
N
(sin θ ) V
O
(cos θ ) V
V sin θ V
X N
cos θ Rotation Matrix about the z-
XY
V
Y O axis
V sin θ cos θ V
93
Y1
(VN,VO)
Y0
VNO
VXY
X1
P
Translation along P followed by rotation by
X0
V Px sin θ V
X N
cos θ
XY
V
Y O
V
Py
sin θ cos θ V
(Note : Px, Py are relative to the original coordinate frame. Translation followed
by rotation is different than rotation followed by translation.)
V sin θ 0 V
X N
Px cos θ Padding with 0’s and 1’s
Y O
V P sin θ cos θ 0 V
y
1 1 0 0 1 1
V sin θ Px V
X N
cos θ
Y O
V sin θ cos θ Py V
Simplifying into a matrix form
1 0 0 1 1
cos θ sin θ Px
H sin θ cos θ Py Homogenous Matrix for a Translation in
XY plane, followed by a Rotation
0 0 1
around the z-axis
95
Rotation Matrices in 3D – OK,lets return from
homogenous repn
cos θ sin θ 0
Rotation around the Z-
R sin θ cos θ 0 Axis
z
0 0 1
cos θ 0 sin θ
Rotation around the Y-
R 0 1 0
y
Axis
sin θ 0 cos θ
1 0 0
Rotation around the X-
R 0 cos θ sin θ
z
Axis
0 sin θ cos θ
96
Homogeneous Matrices in 3D
H is a 4x4 matrix that can describe a translation, rotation, or both in one
matrix O
1 0 0 Px
Y
0 1 0 Py
N H
P
0 0 1 Pz
X A
Translation without 0 0 0 1
Z rotation
n x ox ax 0
Y
O ny oy ay 0
H
N
n z oz az 0
X 0 0 0 1
Rotation part:
Z Rotation without Could be rotation around z-
A axis, x-axis, y-axis or a 97
translation
combination of the three.
Homogeneous Continued….
V
N
Px V
N
n x ox ax
O
n xV o xV a xV Px
X N O A
ny oy ay Py V V
V
XY
n z Pz V
A
oz az
0 0 0 1 1
W
N
Y O
W
W A
T
P
X
Z
W W
I N
W
X
W Pi W
I N
ni oi ai
W ai W
I N
Pi n i oi
O
W
J
n oj aj Pj W
n j
J O
W P oj a j W
j j
W K W K n k Pk W
A
a k W
P k n k ok
A ok ak
1 0 0 0 1 1 99
W
N
Y O
W
W A
T
P
X
Z
W Tx W
X I
ix jx k
W k x W
X I x
Tx i x jx Y J
W i
y
jy k y
Ty
W
i
Y J
W T
y y
jy k y W
W Z iz jz k Tz W
K
W Z
T z i z jz k z W
k
z
1 0 0 0 1 1
W Pi W
X N
i x jx k x
Tx n i oi ai
W
I
W
Y
i jy k Ty n j oj aj Pj W
O
y
J
Substituting W
y
for W K W Z iz jz k Tz n k ok ak Pk W
A
z
1 0 0 0 1 0 0 0 1 1
100
W W
X N
ix jx k x
Tx n i oi ai Pi
Y O
W H W iy jy k Ty n oj aj Pj
H y
j
W Z W A iz jz k Tz n k ok ak Pk
z
1 1 0 0 0 1 0 0 0 1
1 0 0 Tx i x jx k x
0 1 0 0 Pi n i oi ai 0
0 1 0 Ty i y jy k 0 0 1 0 Pj n oj aj 0
H j
y
0 0 1 Tz i z jz k z
0 0 0 1 Pk n k ok ak 0
0 0 0 1 0 0 0 1 0 0 0 1 0 0 0 1
W
N
Y O
W
W A
T
P
X
Z
One more variation on finding H:
This method might seem a bit confusing, but it’s actually an easier
way to solve our problem given the information we have. Here is an 102
example…
FORWARD KINEMATICS
103
The Situation:
You have a robotic arm
that starts out aligned with the xo-
axis.
You tell the first link to move by
1 and the second link to move
by 2.
The Quest:
What is the position of
Solution: the end of the robotic arm?
1. 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 it’s initial position.) For robots with more links and
whose arm extends into 3 dimensions the geometry gets much more
tedious.
3
Y2 2 X3 3
2 X2
Y4
3
Y2 2 X3 3
2 X2
X4
Denavit - Hartenberg
Parameters
107
Denavit-Hartenberg Notation
Z(i - 1)
Y(i -1) Yi Zi
Xi ai
a(i - 1 ) di
X(i -1)
i
( i - 1)
You can
Z(i - 1) align the
two axis
Y(i -1) Yi Zi just using
Xi ai the 4
a(i - 1 ) di parameter
X(i -1)
s
i
( i - 1)
1) a(i-1)
Technical Definition: a(i-1) is the length of the perpendicular between the
joint axes. The joint axes is the axes around which revolution takes place
which are the Z(i-1) and Z(i) axes. These two axes can be viewed as lines
in space. The common perpendicular is the shortest line between the two
axis-lines and is perpendicular to both axis-lines.
109
a(i-1) cont...
Visual Approach - “A way to visualize the link parameter a(i-1) is to imagine
an expanding cylinder whose axis is the Z(i-1) axis - when the cylinder just
touches the joint axis i the radius of the cylinder is equal to a(i-1).” (Manipulator
Kinematics)
110
2) (i-1)
i.e. How much you have to rotate around the X(i-1) axis so that the Z(i-1) is
pointing in the same direction as the Zi axis. Positive rotation follows the
right hand rule.
3) d(i-1)
Z(i - 1)
Technical Definition: The displacement
along the Zi axis needed to align the a(i-1) Y(i -1) Yi Z
i
common perpendicular to the ai common Xi ai
perpendicular. a(i - 1 ) di
X(i -1)
In other words, displacement along the ( i -
i
Zi to align the X(i-1) and Xi axes. 1)
4) i
Amount of rotation around the Zi axis needed to align the X(i-1) axis with111
the
Xi axis.
The Denavit-Hartenberg Matrix
cos θ i sin θ i 0 a (i 1)
sin θ i cos α (i 1) cos θ i cos α (i 1) sin α (i 1) sin α (i 1) d i
sin θ i sin α (i 1) cos θ i sin α (i 1) cos α (i 1) cos α (i 1) d i
0 0 0 1
Z0 Z1
X2
d2
X0 X1
Y0 Y1
Denavit-Hartenberg Link
a0 a1 Parameter Table
i (i-1 ) a (i-1 ) di i
Notice that the table has two
uses:
0 0 0 0 0
1) To describe the robot with its
variables and parameters.
1 0 a0 0 1
2) To describe some state of the
robot by having a numerical 2 -9 0 a1 d2 2
values for the variables.
113
Y2
i ( i- 1 ) a ( i- 1 ) di i
Z0 Z1
0 0 0 0 0
X2
d2
X0 X1 1 0 a0 0 1
Y0 Y1
2 -9 0 a1 d2 2
a0 a1
V 2
X
Y2
T ( 0 T)(
0 1
V
T
X 0Y0Z 0 1
T)( 2
T)
V
V Z2
1 Note: T is the D-H matrix with (i-1) = 0 and i =
1.
114
i ( i- 1 ) a ( i- 1 ) di i sin θ 0
cos θ 0 0 0
sin θ 0 cos θ 0 0 0
0 0 0 0 0 T
0
0 0 1 0
1 0 a0 0 1 0 0 0 1
This is just a rotation around the Z 0
2 -9 0 a1 d2 2 axis
T ( 0 T)(
0 1
1
T)( 2
T) 115
Inverse Kinematics
From Position to Angles
116
A Simple Example
Revolute and
Finding :
Prismatic
y
Joints θ arctan( )
Combined x
More Specifically:
(x , y)
y arctan2() specifies that it’s in the
θ arctan 2 ( ) first quadrant
x
Y
S
1 Finding S:
X
S (x y )
2 2
117
Inverse Kinematics of a Two Link
Manipulator
(x , y) Given: l1, l2 , x , y
2 Find: 1, 2
l2 Redundancy:
A unique solution to this
problem does not exist. Notice, that
using the “givens” two solutions are
1
l1
possible.
Sometimes no solution is possible.
(x , y)
118
The Geometric
Solution (x , y) Using the Law of Cosines:
l2
2
a b 2 ab cos C
2 2 2
c
2 2
( x y ) l1 l 2 2 l1 l 2 cos( 180 θ 2 )
2 2
arccos
1 2
θ2
2 l1 l 2
Using the Law of Cosines:
Redundant since 2 could be in the
sin B sin C
first or fourth quadrant.
b c
sin θ 1 sin(180 θ2) sin( θ 2 )
Redundancy caused since 2 has two
x y x y
2 2 2 2
l2 possible values
θ 1 θ1 α l sin( θ )
θ 1 arcsin
2 2 arctan 2 y
y x2 y2 119
x
α arctan 2
x
The Algebraic Solution
l2 (x , y)
2
c 1 cos θ 1
c 1 2 cos( θ 2 θ 1 )
l1 (1) x l 1 c 1 l 2 c 1 2
(2) y l1 s 1 l 2 sin 1 2
1
(3) θ θ 1 θ 2
(2) x y
2 2 2 2
(1)
2 2 2
l1 c 1 l 2 (c 1 2 ) 2 l1 l 2 c 1 (c 1 2 ) l 1 s 1 l 2 (sin
2 2 2 2
1 2
) 2 l1 l 2 s 1 (sin
2
1 2
)
l 1 l 2 2 l 1 l 2 c 1 (c 1 2 ) s 1 (sin )
2 2
1 2
2 2
l1 l 2 2 l1 l 2 c 2 Only Note :
Unknown
x2 y2 l l
2 2
cos( a b ) (cos a )(cos b ) (sin a )(sin b )
θ2 arccos
1 2
2 l1 l 2 sin( a b ) (cos a )(sin b ) (cos b )(sin
120 a )
x l1 c 1 l 2 c 1 2 Note :
l1 c 1 l 2 c 1 c 2 l 2 s 1 s 2 cos( a b ) (cos a )(cos b ) (sin a )(sin b )
c 1 ( l1 l 2 c 2 ) s 1 ( l 2 s 2 )
sin( a b ) (cos a )(sin b ) (cos b )(sin a )
y l 1 s 1 l 2 sin 1 2
We know what 2 is from the
l1 s 1 l 2 s 1 c 2 l 2 s 2 c 1 previous slide. We need to solve
c 1 ( l 2 s 2 ) s 1 ( l1 l 2 c 2 ) for 1 . Now we have two
equations and two unknowns (sin
x s1 ( l 2 s 2 ) 1 and cos 1 )
c1
( l1 l 2 c 2 )
1
x l 2 s 2 s 1 ( l1
2
l2
2
2 l1 l 2 c 2 ) Notice this is the law of
cosines and can be replaced
( l1 l 2 c 2 )
by x2+ y2
y ( l1 l 2 c 2 ) x l 2 s 2 y (l l c ) x l s
s1 θ 1 arcsin 1 2 2 2 2
2 2 2 2
x y x y
121
UNIT-III
122
DIRECT KINEMATICS
• Manipulator
series of links connected by means of joints
123
Degree of freedom
associated with a joint articulation = joint
variable
Base frame and end-effector frame
124
Two-link planar arm
125
Denavit–Hartenberg convention
126
choose axis zi along axis of Joint i + 1
• locate Oi at the intersection of axis zi with the common normal to axes zi-1 and zi,
and O’i at intersection of common normal with axis zi-1
• choose axis xi along common the normal to axes zi-1 and zi with positive direction
from Joint i to Joint i + 1
• choose axis yi so as to complete right-handed frame
• Nonunique definition of link frame:
For Frame 0, only the direction of axis z0 is specified: then O0 and and X0 can be
chosen arbitrarily.
For Frame n, since there is no Joint n + 1, zn is not uniquely defined while xn has to
be normal to axis zn-1; typically Joint n is revolute and thus zn can be aligned with
zn-1 .
when two consecutive axes are parallel, the common normal between them is not
uniquely defined.
when two consecutive axes intersect, the positive direction of xi is arbitrary.
When Joint i is prismatic, only the direction of zi-1 is specified.
127
Denavit–Hartenberg parameters
128
ai distance between Oi and Oi’;
di coordinate of Oi’ and zi-1;
αi angle between axes z i-1 and z i about axis xi to be taken positive when
rotation is made counter-clockwise
υi angle between axes x i-1 and x i about axis z i-1 to be taken positive when
rotation is made counter-clockwise
ai and αi are always constant
if Joint i is revolute the variable is υi
if Joint i is prismatic the variable is di
129
• Coordinate transformation
130
Procedure
Find and number consecutively the joint axes; set the directions of axes z0,….., zn-1.
Choose Frame 0 by locating the origin on axis z0; axes x0 and y0 are chosen so as to
obtain a righthanded frame. If feasible, it is worth choosing Frame 0 to coincide
with the base frame.
Execute steps from 3 to 5 for i = 1, . . . , n − 1:Find and number consecutively
the joint axes; set the directions of axes z0,….., zn-1.
Choose Frame 0 by locating the origin on axis z 0; axes x0 and y0 are chosen
so as to obtain a righthanded frame. If feasible, it is worth choosing Frame
0 to coincide with the base frame.
Execute steps from 3 to 5 for i = 1, . . . , n − 1:
Locate the origin Oi at the intersection of zi with the common normal to axes
zi-1 and zi . If axes z i-1 and zi are parallel and Joint i is revolute, then locate
Oi so that di=0; if
131
Joint i is prismatic, locate Oi at a reference position for the joint range, e.g.,
a mechanical limit.
Choose axis xi along the common normal to axes zi-1 and zi with direction
from Joint i to Joint i + 1 .
Choose axis yi so as to obtain a right-handed frame to complete.
Choose Frame n; if Joint n is revolute, then align z n with zn-1, otherwise, if
Joint n is prismatic, then choose zn arbitrarily. Axis xn is set according to
step 4.
For i = 1, . . . , n, form the table of parameters a i, di, αi, υi.
On the basis of the parameters in 7, compute the homogeneous
transformation matrices Aii-1 (qi) for i=1, . . . , n.
Compute the homogeneous transformation Tn0(q)=A10…. Ann-1 they yields
the position and orientation of Frame n with respect to Frame 0.
Given T0b and Ten , compute the direct kinematics function as Teb (q)= T0b
Tn0 Ten that yields the position and orientation of the end-effector frame with
respect to the base frame.
132
Three–link planar arm
133
134
Spherical arm
135
136
Anthropomorphic arm
137
138
Spherical wrist
139
140
JOINT SPACE AND OPERATIONAL SPACE
Joint space
qi = υi (revolute joint)
qi = di (prismatic joint)
Operational space
P (position)
Φ (orientation)
141
UNIT-IV
142
INTRODUCTION
Path and trajectory planning means the way that a robot is moved
from one location to another in a controlled manner.
143
PATH VS. TRAJECTORY
Path: A sequence of robot configurations in a particular order
without regard to the timing of these configurations.
144
JOINT-SPACE VS. CARTESIAN-SPACE DESCRIPTIONS
Joint-space description:
- The description of the motion to be made by the robot by its joint values.
- The motion between the two points is unpredictable.
Cartesian space description:
- The motion between the two points is known at all times and controllable.
- It is easy to visualize the trajectory, but is is difficult to ensure that
singularity.
Fig. 5.9 An alternative scheme for ensuring that the robot will go
through a specified point during blending of motion segments.
Two via points D and E are picked such that point B will fall on
Fig. Blending of different motion segments in a path.
the straight-line section of the segment ensuring that the robot
will pass through point B. 150
JOINT-SPACE TRAJECTORY PLANNING
Third-Order Polynomial Trajectory Planning
How the motions of a robot can be planned in joint-space with
controlled characteristics.
Polynomials of different orders
Linear functions with parabolic blends
The initial location and orientation of the robot is known, and using the inverse
kinematic equations, we find the final joint angles for the desired position and
orientation.
( t ) c 0 c1t c 2 t c 3 t
2 3
(ti ) c 0 i
(ti ) i
( t f ) c 0 c1t f c 2 t f c 3 t f
2 3
(t f ) f
( t i ) c 1 0
( t ) c 1 2 c 2 t 3 c 3 t
2
( t i ) 0
First derivative of the ( t f ) c 1 2 c 2 t f 3 c 3 t f 0
2
( t f ) 0 polynomial of equation
Initial Condition Substituting the initial
151
and final conditions
• It is desired to have the first joint of a six-axis robot go from initial angle of 30o to
a final angle of 75o in 5 seconds. Using a third-order polynomial, calculate the
joint angle at 1, 2 3, and 4 seconds.
( t ) c 0 c1t c 2 t c 3 t
2 3
(0 ) c0 3 0
( 0 ) c 1 0
152
JOINT-SPACE TRAJECTORY PLANNING
Fifth-Order Polynomial Trajectory Planning
Specify the initial and ending accelerations for a segment.
To use a fifth-order polynomial for planning a trajectory, the total
number of boundary conditions is 6.
Calculation of the coefficients of a fifth-order polynomial with position,
velocity and a acceleration boundary conditions can be possible with
below equations.
( t ) c 0 c1t c 2 t c 3 t c 4 t c 5 t
2 3 4 5
( t ) c 1 2 c 2 t 3 c 3 t
2
( t ) 2 c 2 6 c 3 t 12 c 4 t 20 c 5 t
2 3
153
JOINT-SPACE TRAJECTORY PLANNING
Linear Segments with Parabolic Blends
Linear segment can be blended with parabolic sections at the
beginning and the end of the motion segment, creating continuous
position and velocity.
Acceleration is constant for the parabolic sections, yielding a continuous
velocity at the common points A and B.
1 1
( t ) c 0 c1t (t ) i
2 2
c2t c2t
2 2
( t ) c 1 c 2 t ( t ) c 2 t
( t ) c 2 ( t ) c 2
The position of the robot at time t0 is known and using the inverse
kinematic equations of the robot, the joint angles at via points and at
the end of the motion can be found.
155
JOINT-SPACE TRAJECTORY PLANNING
Higher Order Trajectories
Incorporating the initial and final boundary conditions together with
this information enables us to use higher order polynomials in the
below form, so that the trajectory will pass through all specified points.
n 1
( t ) c 0 c1t c 2 t c 3 t c n 1t cnt
2 3 n
156
CARTESIAN-SPACE TRAJECTORIES
Cartesian-space trajectories relate to the motions of a robot relative to
the Cartesian reference frame.
In Cartesian-space, the joint values must be repeatedly calculated
through the inverse kinematic equations
of the robot.
(1) Calculate the position and orientation of the hand based on the selected
function for the trajectory.
(2) Calculate the joint values for the position and orientation through the
inverse kinematic equations of the robot.
(3) Send the joint information to the controller.
(4) Go to the beginning of the loop 157
UNIT-V
158
APPLICATION OF ROBOT’S
Robot applications can be studied under present and future
applications.
Under present applications they can be classified into three
major headings. They are
[Link] Transfer, Machine Loading and Unloading.
[Link] operations.
[Link] and inspection.
159
In future applications category the list is exhaustive
and ever increasing like
[Link]
2. Military (Artillery, Loading, Surveillance)
[Link] applications.
[Link] industry.
[Link] automated machine shop etc.,
160
MATERIAL HANDLING APPLICATIONS:
The material handling applications can be divided into two
specific categories
1. Material transfer applications.
2. Machine loading/ unloading applications
161
GENERAL CONSIDERATIONS IN ROBOT MATERIAL
HANDLING:
If a robot has to transfer parts or load a machine, then the following
points are to be considered.
163
MACHINE LOADING:
The robot loads the raw material into the machine but
the part/material is ejected by some other means.
MACHINE UNLOADING:
In this case the loading of raw material into the
machine is done automatically but after completing the
process the finished component is removed by robot.
164
Robots are being successfully used to in the
loading and unloading function in the following
production operations. They are
1. Die casting.
2. Plastic molding.
3. Forging and related operations.
4. Machining operations.
5. Stamping press operations.
165
PROCESSING OPERATIONS: The processing
operations that are performed by a robot can be
categorized into the following four types. They are
[Link] welding.
[Link] arc welding.
[Link] coating.
[Link] processing operations.
166 16
6