Professional Documents
Culture Documents
Kinematics of Robotics
Kinematics of Robotics
(EMeng 6012)
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)
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
Solution
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.
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.
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
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
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
Cont...
Example: Inverse kinematics The aim is to determine Joint angles of all joints .
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 )
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...
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