You are on page 1of 63

Robotics

(EMeng 6012)

Kinematics of Robotics

Getnet Ayele (PhD)


Department of Mechanical Engineering
Faculty of Mechanical And Industrial Engineering
Bahir Dar Institute of Technology, Bahir Dar University
Bahir Dar, Ethiopia.
Kinematics of Robotics

• Kinematics deals with the study of motion without considering the forces acting
on the robot structure. (e.g. position, velocity, acceleration, higher derivatives of
the position)

1. Forward Kinematics: Required position and orientation is determined from a


given set of joint angles.
2. Inverse Kinematics: Joint angles of all joints in the arm are determined from
the given position and orientation.

Robot Motion
1. Point to point motion: The path has no importance.
2. Continuous path motion: The path taken is very important.

 Path taken by the robot end effector within the work volume is known as
trajectory.

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 1
Kinematics of Robotics

Cont...

Problem

Given: The manipulator geometrical


parameters
Specify: The position and orientation of
manipulator

Solution

Coordinate system or “Frames” are


attached to the manipulator and objects
in the environment

 Linear movement => Force acting  We study the motion of different


 Rotary movement => Torque acting Joint angles and links geometry

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 2
Kinematics of Robotics

Cont...
Representation of 3D objects
 U-Represent universal coordinate(reference
frame) of axis XU, YU and ZU.
 B- Represent Body coordinate (body frame) of
axis XB, YB and ZB.
How Represent position and orientation of 3D
object?
We find the mass center of the 3D object and
coordinate system XB,YB and ZB

 3-Position
 3-Rotation/Orientation

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 3
Kinematics of Robotics

Cont...
Representation of the position
The location of any point in can be described as a 3x1 position vector in a reference coordinate
system

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 4
Kinematics of Robotics

Cont...
Representation of the Rotation/ Orientation
The orientation of a body is described by attaching a coordinate system to the body {B} and then
defining the relationship between the body frame and the reference frame {A} using the rotation
matrix.

The rotation matrix describing frame {B}


relative to frame {A}

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 5
Kinematics of Robotics

Cont...
Description of Frame
The information needed to completely specify where is the manipulator hand is a position and an
orientation.

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 6
Kinematics of Robotics

Cont...
Homogeneous Transformation
 Translation
 Translation is the linear displacement made by a point along a straight line
about x, y or z axis.
 Rotation
 Rotation is the angular displacement made by a point about x, y or z axis.

Roll- rotation moment in X axis


Pitch- rotation moment in Y axis
Yaw- rotation moment in Z axis

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 7
Kinematics of Robotics

Cont...
Mapping - Translated Frames
Assuming that frame {B} is only translated (not rotated) with respect frame {A}.
The position of the point can be expressed in frame {A} as follows.

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 8
Kinematics of Robotics

Cont...
Mapping - Rotated Frames
Assuming that frame {B} is only rotated (not translated) with respect frame {A} (the origins of the
two frames are located at the same point) the position of the point in frame {B} can be expressed
in frame {A} using the rotation matrix as follows:

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 9
Kinematics of Robotics

Cont...
Mapping - Rotated Frames- Inversion

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 10
Kinematics of Robotics

Cont...
Example- Mapping - Rotated Frame

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 11
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 12
Kinematics of Robotics

Cont...
Mapping - Rotated Frames - General Notation

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 13
Kinematics of Robotics

Cont...
Mapping - Rotated Frames - Methods

• X-Y-Z Fixed Angles


The rotations perform about an axis of a fixed reference frame

• Z-Y-X Euler Angles


The rotations perform about an axis of a moving reference frame

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 14
Kinematics of Robotics

Cont...
Mapping - Rotated Frames - X-Y-Z Fixed Angles

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 15
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 16
Kinematics of Robotics

Cont...
Mapping - Rotated Frames - Z-Y-X Euler Angles

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 17
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 18
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 19
Kinematics of Robotics

Cont...
Operator - Rotating Vector

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 20
Kinematics of Robotics

Cont...
Example: Operator - Rotating Vector

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 21
Kinematics of Robotics

Cont...
Mapping - General Frames

T-Transform

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 22
Kinematics of Robotics

Cont...
Mapping - Homogeneous Transform

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 23
Kinematics of Robotics

Cont...
Homogeneous Transform - Special Cases

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 24
Kinematics of Robotics

Cont...
Example: Homogeneous Transform

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 25
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 26
Kinematics of Robotics

Cont...
Transformation Arithmetic - Compound Transformations

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 27
Kinematics of Robotics

Cont...
Transformation Arithmetic - Inverted Transformation

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 28
Kinematics of Robotics

Cont...
Example : Inverted Transformation

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 29
Kinematics of Robotics

Cont...
Roll, Pitch and Yaw

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 30
Kinematics of Robotics

Cont...
Example : Roll, Pitch and Yaw

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 31
Kinematics of Robotics

Cont...
Denenvit-Hartenberg (DH) parameters/notations
• Proposed in the year 1995

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 32
Kinematics of Robotics

Cont...
Link Parameters (Denenvit-Hartenberg )- Length & Twist

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 33
Kinematics of Robotics

Cont...
Joint Variables (Denenvit-Hartenberg ) - Angle & Offset

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 34
Kinematics of Robotics

Cont...
DH Parameters Table

Example: For frame 1


Joint Z0 parallel Joint Z1
Frame X0 intersect frame X1

Like wise for frame 2


 Frame X1 same line frame X2 is the distance is zero
 Joint Z1 parallel Joint Z2 is the angle is zero

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 35
Kinematics of Robotics

Cont...
Example: Derivation of link Homogeneous Transformation
Find the translation of Axis i-1 -> Axis i

i 1
iT  RX ( i 1 )Trans X (ai 1 ) RZ ( i )TransZ (d i )
Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 36
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 37
Kinematics of Robotics

Cont...
Summery

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 38
Kinematics of Robotics

Cont...
Kinematics Relations - Forward & Inverse

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 39
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 40
Kinematics of Robotics

Cont...
Example: Forward kinematics

DH Parameters Table

The aim is to determine position and orientation.


Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 41
Kinematics of Robotics

Cont...
Example: Inverse kinematics The aim is to determine Joint angles of all joints .

C12  C1C2  S1S 2


From Eq. 1
DH Parameters Table

L1  L2C2   sin  L2 S 2   cos 


Eq.1
Eq.2 q x  C1  sin   S1 cos    sin(  1 )
L L S
By squiring and adding Eq. 1 and Eq. 2   tan 1 1 2 2
L2 S 2
Same step like

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 42
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 43
Kinematics of Robotics

Cont...
Forward & Inverse: Method of Solution

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 44
Kinematics of Robotics

Cont...
Example: Inverse Kinematics - 3D RRR (3R) - Geometric Solution

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 45
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 46
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 47
Kinematics of Robotics

Cont...
Examples: PUMA 560- Algebraic Solution
DH- Parameter

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 48
Kinematics of Robotics

Cont...
Link Transformation

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 49
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 50
Kinematics of Robotics

Cont...
Examples: Stanford Manipulator- Algebraic Solution
DH- Parameter

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 51
Kinematics of Robotics

Cont...
Link Transformation

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 52
Kinematics of Robotics

Cont...
Kinematics Relations - Joint & Cartesian Spaces

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 53
Kinematics of Robotics

Cont...
 Jacobian Matrix The Jacobian is a multi dimensional
form of the derivative.
Suppose that for example we have 6
functions, each of which is a function of
6 independent variables

y1  f1 ( x1 , x2 , x3 , x4 , x5 , x6 )
y2  f 2 ( x1 , x2 , x3 , x4 , x5 , x6 )

y6  f 6 ( x1 , x2 , x3 , x4 , x5 , x6 )

We may also use a vector notation to


write these equations as

Y  F (X )

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 54
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 55
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 56
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 57
Kinematics of Robotics

Cont...
Example: Jacobian Matrix by Differentiation - 1R

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 58
Kinematics of Robotics

Cont...

• The moment about the joint


generated by the force acting on
the end effector is given by

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 59
Kinematics of Robotics

Cont...
Concept of Singularity

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 60
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 61
Kinematics of Robotics

Cont...

Getnet Ayele (PhD), Robotics, BiT (Faculty Of Mechanical And Industrial Engineering), Bahir Dar, Ethiopia. 62

You might also like