Professional Documents
Culture Documents
Introduction To ROBOTICS: Kinematics of Robot Manipulator
Introduction To ROBOTICS: Kinematics of Robot Manipulator
• Robot Manipulators
– Robot Configuration
– Robot Specification
• Number of Axes, DOF
• Precision, Repeatability
• Kinematics
– Preliminary
• World frame, joint frame, end-effector frame
• Rotation Matrix, composite rotation matrix
• Homogeneous Matrix
– Direct kinematics
• Denavit-Hartenberg Representation
• Examples
– Inverse kinematics
5
The City College of New York
A150 Robotic Arm
link 3
link 2
6
The City College of New York
Joints
7
The City College of New York
Joint Variables
8
The City College of New York
Revolute Joint Variable
• revolute
– qi = i : angle of rotation of link i relative to link
link i
i–1
i
link i – 1
9
The City College of New York
Prismatic Joint Variable
• prismatic
– qi = di : displacement of link i relative to link i –
1
link i – 1 link i
di
10
The City College of New York
Common Manipulator Arrangments
11
The City College of New York
Articulated Manipulator
• RRR (first three joints are all revolute)
• joint axes
– z0 : waist
z0
– z1 : shoulder (perpendicular to z0) z1 z2
waist
12
The City College of New York
Spherical Manipulator
• RRP
• Stanford armz 0
z 1
– d3
http://infolab.stanford.edu/pub/voy/museum/pictures/display/robots/IMG_2404ArmFrontPeek
ingOut.JPG
2
shoulder z2
1
waist
13
The City College of New York
SCARA Manipulator
• RRP
• Selective Compliant
z
Articulated Robot for
z 1 2
Assemblyz 0
2
– http://www.robots.epson.com/products/g-series.htm
d3
1
14
The City College of New York
Manipulators
• Robot Configuration:
Hand coordinate:
x
Y ( x, y, z , O, A, T )
q (q1 , q2 , q3 , q4 , q5 , q6 , qn ) x
Forward kinematics y0
x1 l cos y1
x1
y1 l sin
l
Inverse kinematics
1
x0
cos ( x1 / l )
a2
2
a1
1
21
The City College of New York
Forward Kinematics
• choose the base coordinate frame of the robot
– we want (x, y) to be expressed in this frame
(x, y) ?
a2
2
y0
a1
1
x0
22
The City College of New York
Forward Kinematics
• notice that link 1 moves in a circle centered on the base
frame origin
(x, y) ?
a2
2
y0
a1
1 ( a1 cos 1 , a1 sin 1 )
x0
23
The City College of New York
Forward Kinematics
• choose a coordinate frame with origin located on joint 2
with the same orientation as the base frame
(x, y) ?
y1
a2
2
y0
1
a1 x1
1 ( a1 cos 1 , a1 sin 1 )
x0
24
The City College of New York
Forward Kinematics
• notice that link 2 moves in a circle centered on frame 1
(x, y) ?
y1
a2
( a2 cos (1 + 2),
2 a2 sin (1 + 2) )
y0
1
a1 x1
1
( a1 cos 1 , a1 sin 1 )
x0
25
The City College of New York
Forward Kinematics
• because the base frame and frame 1 have the same orientation, we
can sum the coordinates to find the position of the end effector in
the base frame (a1 cos 1 + a2 cos (1 + 2),
a1 sin 1 + a2 sin (1 + 2) )
y1
a2
( a2 cos (1 + 2),
2 a2 sin (1 + 2) )
y0
1
a1 x1
1
( a1 cos 1 , a1 sin 1 )
x0
26
The City College of New York
Forward Kinematics
• we also want the orientation of frame 2 with respect to
the base frame y2 x2
– x2 and y2 expressed in terms
of x0 and y0
a2
2
y0
1
a1
1
x0
27
The City College of New York
Forward Kinematics
x2 = (cos (1 + 2),
y2 x2
sin (1 + 2) )
y2 = (-sin (1 + 2),
cos (1 + 2) )
a2
2
y0
1
a1
1
x0
28
The City College of New York
Inverse Kinematics
• given the position (and possibly y2 x2
the orientation) of the end
(x, y)
effector, and the dimensions
of the links, what are the joint a
2
variables?
2 ?
y0
a1
1 ?
x0
29
The City College of New York
Inverse Kinematics
• harder than forward kinematics because there is often
more than one possible solution
(x, y)
a2
y0
a1
x0
30
The City College of New York
Inverse Kinematics
law of2 cosines
b a1 a2 2a1a2 cos( 2 ) x 2 y 2
2 2
(x, y)
a2
b
2 ?
y0
a1
x0
31
The City College of New York
Inverse Kinematics
x 2 y 2 a12 a22
cos( 2 )
2a1a2
and we have the trigonometric identity
cos( 2 ) cos( 2 )
therefore,
x 2 y 2 a12 a22
cos 2 C2
2a1a2
We could take the inverse cosine, but this gives only one of the two solutions.
32
The City College of New York
Inverse Kinematics
Instead, use the two trigonometric identities:
sin
sin 2 cos 2 2 1 tan
cos
to obtain
2
1 C 2
2 tan 1
C2
which yields both solutions for 2 . In many programming languages you would use the
four quadrant inverse tangent function atan2
33
The City College of New York
Inverse Kinematics
y 1 a2 sin 2
1 tan tan
1
x a1 a2 cos 2
34
The City College of New York
Preliminary
• Robot Reference Frames
– World frame
– Joint frame
z
– Tool frame y
z x
y T P
W
x
R
36
The City College of New York
Coordinate Frames
– Since P pu i u pv jv pw k w
p x i x P i x i u pu i x jv pv i x k w pw
p y jy P jy i u pu jy jv pv jy k w pw
p z k z P k z i u pu k z jv pv k z k w pw
pu i u i x i u jy i u k z px
p j i jv j y
jv k z p y Puvw QPxyz
v v x
pw k w i x k w jy k w k z p z
Q R 1 R T
QR R T R R 1 R I 3 <== 3X3 identity matrix
47 05/13/23
The City College of New York
Example
• A point auvw (4,3,2) is attached to a rotating frame,
the frame rotates 60 degree about the OZ axis of
the reference frame. Find the coordinates of the
point relative to the reference frame after the
rotation.
a xyz Rot ( z ,60)auvw
0.5 0.866 0 4 0.598
0.866 0.5 0 3 4.964
0 0 1 2 2
ŷ0 ŷ1
x̂0 x̂1
o0 o1
0
1
3 0
o 1
0
• suppose we are given o1 expressed in {0}
52
The City College of New York
Translation 1
ŷ0 ŷ1
x̂0 x̂1
o0 o1
0
1
0 3 0 3
0 0
d o o
1 1 0
0 0 0
• the location of {1} expressed in {0}
53
The City College of New York
Translation 1
i
d
1. the translation vector j can be
interpreted as the location of frame {j}
expressed in frame {i}
54
The City College of New York
Translation 2
a point expressed
in frame {1}
interpreted as a coordinate
transformation of a point from frame {j} to
frame {i}
56
The City College of New York
Translation 3
1 ŷ0 2
0 0
p q
1 1
x̂0
o0
0
0 3 1 2
0
q d p
0 1 1
• q0 expressed in {0}
57
The City College of New York
Translation 3
3. the translation vector d can be
interpreted as an operator that takes a
point and moves it to a new point in the
same frame
58
The City College of New York
Coordinate Transformations
• position vector of P
in {B} is transformed
to position vector of P
in {A}
• description of {B} as
seen from an observer
in {A}
1. Translation only
– Axes of {B} and {A} are
parallel A
RB 1
2. Rotation only
– Origins of {B} and {A}
are coincident A
ro' 0
The City College of New York 60
Homogeneous Representation
• Coordinate transformation from {B} to {A}
A A B A
rP RB rP ro'
A
I 3 3 roA'
TB
01 3 1
2. Rotation
A A
RB 031
TB
013 1
y
u
x
The City College of New York 64
Homogeneous Transformation
• Composite Homogeneous Transformation
Matrix
• Rules:
– Transformation (rotation/translation) w.r.t
(X,Y,Z) (OLD FRAME), using pre-
multiplication
– Transformation (rotation/translation) w.r.t
(U,V,W) (NEW FRAME), using post-
multiplication
y1 x2
z0 0
A1 1
A2
y0
x1
x0
?
i 1
Ai Transformation matrix for
adjacent coordinate frames
0
A2 0A1 1 A2 Chain product of successive
coordinate transformation matrices
x5 0 1 0 b
y5 z4 0 0 1 a d
e 1
A2
a x4 y4 z2 1 0 0 0
x2
0 0 0 1
z1 x1 y2
z0 0 1 0 b
y1 1 0 0 e c
x0
y0 0
Can you find the answer by observation basedA2
0 0 1 0
on the geometric interpretation of
homogeneous transformation matrix? 0 0 0 1
The City College of New York 70
Orientation Representation
R33 P31
F
0 1
• Rotation matrix representation needs 9
elements to completely describe the
orientation of a rotating rigid body.
• Any easy way?
w'= z
w'"= w"
v'"
v"
v'
y
u'"
u' =u"
x
w'= z
w"'= w"
v"'
v' =v"
y
u"'
u"
Note the opposite u'
(clockwise) sense of the x
third rotation, .
The City College of New York 76
Orientation Representation
• Matrix with Euler Angle II
sin sin sin cos
cos sin
cos cos cos sin cos cos
cos sin cos cos sin sin
sin cos cos sin cos cos
cos
cos sin sin sin
Y
X
– then
1 R T
R T
d
T
0 0 0 1
79
The City College of New York
Thank you!
Homework 1 is posted on the web.
x
The City College of New York 80