0% found this document useful (0 votes)
168 views166 pages

Robotics Latest

The document provides an introduction to robotics and industrial manipulator robots. It discusses key robotics terminology like robot, robotics, telerobotics and the three laws of robotics proposed by Asimov. Ideal robot tasks are described as dangerous, boring/repetitive and requiring high precision or speed. A timeline of robotics development is also presented. Common robot configurations like Cartesian, cylindrical, spherical and articulated robots are described along with their work envelopes. Control methods like non-servo control and servo control are summarized. Robot programming methods including teach pendants, lead through programming and offline robot programming languages are also introduced.

Uploaded by

fikadu
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as PDF, TXT or read online on Scribd
0% found this document useful (0 votes)
168 views166 pages

Robotics Latest

The document provides an introduction to robotics and industrial manipulator robots. It discusses key robotics terminology like robot, robotics, telerobotics and the three laws of robotics proposed by Asimov. Ideal robot tasks are described as dangerous, boring/repetitive and requiring high precision or speed. A timeline of robotics development is also presented. Common robot configurations like Cartesian, cylindrical, spherical and articulated robots are described along with their work envelopes. Control methods like non-servo control and servo control are summarized. Robot programming methods including teach pendants, lead through programming and offline robot programming languages are also introduced.

Uploaded by

fikadu
Copyright
© © All Rights Reserved
We take content rights seriously. If you suspect this is your content, claim it here.
Available Formats
Download as PDF, TXT or read online on Scribd

INSTITUTE OF AERONAUTICAL ENGINEERING

(Autonomous)
Dundigal, Hyderabad - 500 043

DEPARTMENT OF MECHANICAL ENGINEERING


Course: ROBOTICS

Course Code: A70355


IV [Link] I Sem
JNTUH- R15

Prepared by : Mr. A Anudeep Kumar


Assistant Professor

1
UNIT-I

2
Introduction to Robotics

We will be studying Industrial manipulator


type Robots.

3
• Introduction to Robotics
• Classification of Robots
• Robot coordinates
• Work volumes and Reference Frames
• Robot Applications.

4
Automation vs. robots

• Automation –Machinery designed to carry out a specific task


– Bottling machine (These are always better
– Dishwasher than robots, because they
can be optimally designed
– Paint sprayer for a particular task).

• Robots – machinery designed


to carry out a variety of tasks
– Pick and place arms
– Mobile robots
– Computer Numerical Control
machines
5
“Robot” coined by Karel Capek in a 1921 science-fiction Czech play

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”

 Law 1: A robot may not injure a human being or


through inaction, allow a human being to come to
harm.
 Law 2: A robot must obey orders given to it by
human beings, except where such orders would
conflict with the first law.
 Law 3: A robot must protect its own existence as long
as such protection does not conflict with the first law.

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

• Acutators : Actuators are the muscles of the


manipulators. Common types of actuators are
servomotors, stepper motors, pneumatic cylinders etc.

• Sensors : Sensors are used to collect information about


the internal state of the robot or to communicate with
the outside environment. Robots are often equipped
with external sensory devices such as a vision system,
touch and tactile sensors etc which help to
communicate with the environment

• Controller : The controller receives data from the


computer, controls the motions of the actuator and
coordinates these motions with the sensory feedback
information. 12
Robot Configurations
Some of the commonly used configurations in Robotics are

• Cartesian/Rectangular Gantry(3P) : These Robots are made of 3


Linear joints that orient the end effector, which are usually followed
by additional revolute joints.

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.

• Alternately Workspace may be found empirically,


by moving each joint through its range of
motions and combining all space it can reach
and subtracting what space it cannot reach

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.

• Closed-loop robots use sensors


in conjunction with actuators to
gain higher accuracy – servo
motors.

• Uses include mobile robotics,


telepresence, search and
rescue, pick and place with
machine vision.
39
Measures of performance
• Working volume
– The space within which the robot operates.
– Larger volume costs more but can increase
the capabilities of a robot

• Speed and acceleration


– Faster speed often reduces resolution or
increases cost
– Varies depending on position, load.
– Speed can be limited by the task the robot
performs (welding, cutting)

• 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

Varies depending on position,


load

41
Control

•Open loop, i.e., no feedback, deterministic

•Closed loop, i.e., feedback, maybe a sense of


touch and/or vision

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

Tools – to perform a process, e.g., spot welding, spray


painting

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

Multilateral – more than two points or surfaces touching the


components to be handled (fig.a)

53
Gripper
End-effector that holds or grasp an object (in assembly, pick
and place operation and material handling) to perform
some task.

Four Major Types of gripper


[Link]
[Link] or vaccum cups [Link] gripper
[Link]

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

Four ways of gripper mechanism based on kinematic devices


[Link] actuation
[Link] and rack actuation [Link] actuation
[Link] actuation

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

 Adhesive Substance can be used for grasping action in adhesive grippers.


 In adhesive grippers, the adhesive substance losses its tackiness due to repeated
usage. This reduces the reliability of the gripper. In order to overcome this difficulty,
the adhesive material is continuously fed to the gripper in the form of ribbon by
feeding mechanism.
 A major asset of the adhesive gripper is the fact that it is simple. As long as the
adhesive keep its stickiness it will continue to function without maintenance,
however, there are certain limitations, the most significant is the fact that the
adhesive cannot readily be disabled in order to release the grasp on an object.
Some other means, such as devices that lock the gripped object into place, must
be used.
 The adhesive grippers are used for handling fabrics and other lightweight
materials.

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

Forward Kinematics (angles to position)


What you are given: The length of each link
The angle of each joint

What you can find: The position of any point


(i.e. it’s (x, y, z) coordinates

Inverse Kinematics (position to angles)


What you are given: The length of each link
The position of some point on the robot

What you can find: The angles of each joint needed to


obtain
that position

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

Translation Along the X-Axis


Y O

(VN,VO)

VO

P
N
X VN
Px

Px = distance between the XY and NO coordinate planes

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

n Unit vector along the N-Axis


o Unit vector along the N-
Axis VO
NO
V Magnitude of the VNO
vector 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

 = Angle of rotation between the XY and NO coordinate axis

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 (cos( θ  90))


N O

 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 

Written in Matrix Form

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.)

In other words, knowing the coordinates of a point (VN,VO) in some coordinate


frame (NO) you can find the position of that point relative to your original
coordinate frame (X0Y0).
94
HOMOGENEOUS REPRESENTATION
Putting it all into a Matrix

V   Px   sin θ   V  What we found by doing a


X N
 cos θ
       
XY
V
Y  O  translation and a rotation
V  
Py
  sin θ cos θ   V 

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

 O  The (n,o,a) position of a point relative to the


 V 
 H
XY
V current coordinate frame you are in.
V A 
 
 1 

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 

The rotation and translation part can be combined into a single


homogeneous matrix IF and ONLY IF both are relative to the same
coordinate frame.
98
Finding the Homogeneous Matrix
EX.

W 
N

Y  O 
W 
W A

 
T
P
X

Z
W  W 
I N
W 
X

  Point relative to the  J  Point relative to the  O  Point relative to the


Y
 W  W 
W  X-Y-Z frame I-J-K frame N-O-A frame
W Z
 W K  W A

     

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 

Product of the two


matrices
Notice that H can also be written as:

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

H = (Translation relative to the XYZ frame) * (Rotation relative to the XYZ


frame)
* (Translation relative to the IJK frame) * (Rotation relative to the IJK
frame)
101
The Homogeneous Matrix is a concatenation of
numerous translations and rotations

W 
N

Y  O 
W 
W A

 

T
P
X

Z
One more variation on finding H:

H= (Rotate so that the X-axis is aligned with T)


* ( Translate along the new t-axis by || T || (magnitude of T))
* ( Rotate so that the t-axis is aligned with P)
* ( Translate along the p-axis by || P || )
* ( Rotate so that the p-axis is aligned with the O-axis)

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.

2. Algebraic Approach 104


Involves coordinate transformations.
Example Problem:
You are have a three link arm that starts out aligned in the x-
axis. Each link has lengths l1, l2, l3, respectively. You tell the first one to
move by 1 , and so on as the diagram suggests. Find the
Homogeneous matrix to get the position of the yellow dot in the X 0Y0
frame. Y 3

3

Y2 2 X3 3
2 X2

H = Rz(1 ) * Tx1(l1) * Rz(2 ) * Tx2(l2) * Rz(3 )

Y0 i.e. Rotating by 1 will put you in the X1Y1 frame.


1
Translate in the along the X1 axis by l1.
Rotating by 2 will put you in the X2Y2 frame.
1
X0
and so on until you are in the X3Y3 frame.

The position of the yellow dot relative to the X3Y3 frame is


(l1, 0). Multiplying H by that position vector will give you th
coordinates of the yellow point relative the the X 0Y105
0 frame.
Slight variation on the last solution:
Make the yellow dot the origin of a new coordinate X4Y4 frame
Y3

Y4
3

Y2 2 X3 3
2 X2
X4

H = Rz(1 ) * Tx1(l1) * Rz(2 ) * Tx2(l2) * Rz(3 ) * Tx3(l3)


Y0
1
This takes you from the X0Y0 frame to the X4Y4
frame.
1
X0
The position of the yellow dot relative to the X4Y4
frame is (0,0).
X  0 
   
Y 0
   H   Notice that multiplying by the (0,0,0,1) vector
Z  0 
will equal the last column of the H matrix.
   
 1  1  106
More on Forward Kinematics…

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)

IDEA: Each joint is assigned a coordinate frame. Using the


Denavit-Hartenberg notation, you need 4 parameters to describe
how a frame (i) relates to a previous frame ( i -1 ).

THE PARAMETERS/VARIABLES: , a , d,  108


The Parameters

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)

It’s Usually on the Diagram Approach - If the diagram already specifies


the various coordinate frames, then the common perpendicular is usually
the X(i-1) axis. So a(i-1) is just the displacement along the X(i-1) to move from
the (i-1) frame to the i frame.

If the link is prismatic, then a(i-1)


is a variable, not a parameter. Z(i - 1)
Y(i -1) Yi Zi
Xi ai
a(i - 1 ) di
X(i -1)
i
( i - 1)

110
2) (i-1)

Technical Definition: Amount of rotation around the common perpendicular


so that the joint axes are parallel.

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 

Just like the Homogeneous Matrix, the Denavit-Hartenberg Matrix is a


transformation matrix from one coordinate frame to the next. Using a
series of D-H Matrix multiplications and the D-H Parameter table, the
final result is a transformation matrix from some frame to your initial
frame.
Put the transformation here Z(i -
1) Y(i - Y Z
1) i i X a
a(i - d
X(i - i i
1) i 
( i 1)
i
- 1)
112
3 Revolute Joints Y2

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

 cos θ 1  sin θ 1 0 a0  cos θ 2  sin θ 2 0 a1 


   
sin θ 1 cos θ 1 0 0 0 0 1 d2
0
T    1
T   
1 2
 0 0 0 0    sin θ 2  cos θ 2 0 0 
   
 0 0 0 1   0 0 0 1 
This is a translation by a1 and then d2
This is a translation by a0 followed by
followed by a rotation around the X2
a rotation around the Z1 axis
and Z2 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

cos( 180  θ 2 )   cos( θ 2 )


2 2
x  y  l1  l 2
2 2
l1
 cos( θ 2 ) 
2 l1 l 2
1
 x2  y2  l  l 
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 )

x  s1 ( l 2 s 2 ) Substituting for c1 and


y  ( l 2 s 2 )  s 1 ( l1  l 2 c 2 ) simplifying many times
( 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

Kinematic chain (from base to end-effector)


open (only one sequence)
closed (loop)

123
Degree of freedom
associated with a joint articulation = joint
variable
Base frame and end-effector frame

Direct kinematics equation

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)

Direct kinematics equation


x = k(q)

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.

 The sequence of movements for a controlled movement between


motion segment, in straight-line motion or in sequential motions.

 It requires the use of both kinematics and dynamics of robots.

143
PATH VS. TRAJECTORY
 Path: A sequence of robot configurations in a particular order
without regard to the timing of these configurations.

 Trajectory: It concerned about when each part of the path must


be attained, thus specifying timing.

Fig. Sequential robot movements in a path.

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. Cartesian-space trajectory (a) The trajectory specified in


145
Cartesian coordinates may force the robot to run into itself, and (b)
Fig. Sequential motions of a robot
to follow a straight line. the trajectory may requires a sudden change in the joint angles.
BASICS OF TRAJECTORY PLANNING
 Let’s consider a simple 2 degree of freedom robot.
 We desire to move the robot from Point A to Point B.
 Let’s assume that both joints of the robot can move at the maximum
rate of 10 degree/sec.
 Let’s assume that both joints of the robot can move at the maximum
rate of 10 degree/sec.

 Move the robot from A to B, to run both joints


at their maximum angular velocities.
 After 2 [sec], the lower link will have finished its
motion, while the upper link continues for another
3 [sec].
 The path is irregular and the distances traveled
by the robot’s end are not uniform.
146
Fig. 5.4 Joint-space nonnormalized movements
of a robot with two degrees of freedom.
BASICS OF TRAJECTORY PLANNING
 Let’s assume that the motions of both joints are normalized by a
common factor such that the joint with smaller motion will move
proportionally slower and the both joints will start and stop their
motion simultaneously.

 Both joints move at different speeds, but move


continuously together.
 The resulting trajectory will be different.

Fig. Joint-space, normalized movements


of a robot with two degrees of freedom. 147
BASICS OF TRAJECTORY PLANNING
 Let’s assume that the robot’s hand follow a known path between point
A to B with straight line.
 The simplest solution would be to draw a line between points A and B,
so called interpolation.

 Divide the line into five segments and solve for


necessary angles  and  at each point.
 The joint angles are not uniformly changing.

Fig. Cartesian-space movements of


a two-degree-of-freedom robot. 148
BASICS OF TRAJECTORY PLANNING
 Let’s assume that the robot’s hand follow a known path between point A to B with straight line.
 The simplest solution would be to draw a line between points A and B, so called interpolation.

 It is assumed that the robot’s actuators are


strong enough to provide large forces necessary
to accelerate and decelerate the joints as needed.
 Divide the segments differently.
 The arm move at smaller segments as we speed up at
the beginning.
 Go at a constant cruising rate.
 Decelerate with smaller segments as approaching
point B.
Fig. Trajectory planning with an
acceleration-deceleration regiment.
149
BASICS OF TRAJECTORY PLANNING
 Next level of trajectory planning is between multiple points for
continuous movements.
 Stop-and-go motion create jerky motions with unnecessary stops.
 Blend the two portions of the motion at point B.
 Specify two via point D and E before and after point B

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

Fig. Scheme for linear segments with parabolic blends. 154


JOINT-SPACE TRAJECTORY PLANNING
Linear Segments with Parabolic Blends and Via Points

 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.

• To blend the motion segments together, the boundary conditions of


each point to calculate the coefficients of the parabolic segments is
used.
• Maximum allowable accelerations should not be exceeded.

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

• It requires extensive calculation for each joint and higher order


polynomials.
• Combinations of lower order polynomials for different segments of
the trajectory and blending together to satisfy all required
boundary conditions is required.

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.

 Computer Loop Algorithm

(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.

1. Part Positioning and Orientation


2. Gripper design
[Link] distances moved
[Link] work volume
[Link] weight capacity
[Link] and repeatability
[Link] configuration
[Link] Utilization Problems
162
MATERIAL TRANSFER APPLICATIONS
1. Pick and place operations.
2. Palletizing and related operations.
[Link] loading and unloading.

In these applications the robot is used to serve a


production machine by transferring parts to and/or
from the machine. This application can be dealt under
the following three headings.

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

You might also like