Professional Documents
Culture Documents
Robot Kinematics
continued.
Homogeneous transformation
Representation of Transformation
RPY
Euler Angles
Homogeneous Transformations
5/4/17 2
5/4/17 3
5/4/17 4
Example
5/4/17 5
Example
5/4/17 6
Transformation Rule
5/4/17 7
Example
5/4/17 8
Homogeneous Representation
5/4/17 9
Homogeneous Representation-Translation
5/4/17 10
Homogeneous Transformation Matrices
5/4/17 11
Homogeneous Transformation Matrices
Representation of Transformation
5/4/17 14
Solution
10
F OLD
matrix
Fnew
5/4/17 15
Pure Rotation about an Axis
5/4/17 16
P(l1- l2, l3+l4)
5/4/17 17
5/4/17 18
Cos 90= 0
5/4/17
Sin 90 =1 19
Rotation of a frame relative to the x-axis of a
reference frame, 90 deg CCW
5/4/17 20
Basic Rotation Matrices
5/4/17 21
Representation of Combined Transformation
5/4/17 22
5/4/17 23
5/4/17 24
Solution
The matrix equation representing the transformation
is :
noa
5/4/17 25
Using Matlab in Matrix multiplication
5/4/17 26
Sequence of implementation
5/4/17 27
Inverse of Transformation Matrices
5/4/17 28
5/4/17 29
5/4/17 30
5/4/17 31
Angle is 30
degrees
Solution
5/4/17 32
Forward Kinematics
5/4/17 34
Inverse Kinematics
5/4/17 35
Example
5/4/17 36
Forward kinematics
5/4/17 39
5/4/17 40
Dot Product: Properties
5/4/17 41
Coordinate Transformation
5/4/17 42
Basic Rotation
5/4/17 43
Rotation Matrix
5/4/17 44
5/4/17 45
Basic Rotation Matrix
5/4/17 46
Rotation Matrix
5/4/17 47
Example
Note
5/4/17 48
Composite Rotation Matrix
5/4/17 49
5/4/17 50
Coordinate Transformations
5/4/17 51
Coordinate Transformations
5/4/17 52
Forward and Inverse Kinematic
Equations
Forward kinematics includes substituting
the known joint values into the equations
to find the location and orientation
Inverse kinematics includes finding an
equation that results in joint values if the
desired position and orientation are
specified.
Forward and Inverse Kinematics for
Position
Four possibilities are common:
a. Cartesian (gantry, rectangular)
coordinates
b. Cylindrical coordinates
c. Spherical coordinates
d. Articulated (anthropomorphic or all-
revolute) coordinates
Cartesian Coordinates
n
p pz
y
px
py
x
Forward and Inverse Kinematics of a Robot
5/4/17 56
Cylindrical Coordinate
5/4/17 57
rSin
rCos
58
SPHERICAL COORDINATES(2RP)
59
DETAILS
60
Product of two rotation matrix about
y and z axis
61
62
Inverse Solution
x y x y x y
RPY Angles Matrix
5/4/17 69
ROLL ,PITCH ,YAW(R,P,Y)
5/4/17 74
5/4/17 75
5/4/17 76
5/4/17 77
Cos 35 deg = 0.819
Sin 35 deg=0.5735
cos -sin 0
R sin cos 0
z
0 0 1
Rotation Parameterization
Represent rotation space in Euclidean
3
R
e.g. Euler angles
Pros
three parameters for three DOFs
Cons
singularities, potentially poor interpolation
Euler angles (,,)
R = R R R
The most common and useful set of such parameters are the Euler angles
A 1
The Euler angles
First, we rotate the system around the z
axis
cos sin 0 x '
0 y '
x' ' Dx' sin cos
0 0 1 z '
x Ax'
The Euler angles
The explicit form of the resultant
transformation matrix A is
A BCD
cos cos cos sin sin cos sin cos cos sin sin sin
sin cos cos sin cos sin sin cos cos cos cos sin
sin sin sin cos cos
X Y X Y X Y
Euler( , , ) Rot ( a, ) Rot (o, ), Rot ( a, )
C C C S S C C S S C C S 0
S C C C S S C S C C S S 0
S C S S C 0
0 0 0 1
ZYX Euler angles
ZYX Euler Angles
Forward and Inverse Kinematics Equations
for Orientation
Euler Angles Representation
Inverse Solution
Use the Formula
ATAN 2(a y , ax ) or ATAN 2(a y , a x )
ATAN 2[(axC a y S ), az )]
5/4/17 106
Figure 1
Figure 2
Figure 3
@ 35
@ 215
@ 35
@ 215
Checke
d
psi
sin 0 0 cos 0 1
sin 180 0 cos 180 -1
theta
sin 50 0.766 cos 50 0.643
sin -50 -0.766 cos -50 0.643