Documenti di Didattica
Documenti di Professioni
Documenti di Cultura
2.1 INTRODUCTION
♦Forward Kinematics:
to determine where the robot’s hand is?
(If all joint variables are known)
♦Inverse Kinematics:
to calculate what each joint variable is?
(If we desire that the hand be
located at a particular point)
Chapter 2
Robot Kinematics: Position Analysis
Fig. 2.1 A one-degree-of-freedom closed-loop Fig. 2.2 (a) Closed-loop versus (b) open-loop
four-bar mechanism mechanism
Chapter 2
Robot Kinematics: Position Analysis
2.3 MATRIX REPRESENTATION
2.3.1 Representation of a Point in Space
♦A point P in space :
3 coordinates relative to a reference frame
^ ^ ^
P = a x i + by j + c z k
♦A Vector P in space :
3 coordinates of its tail and of its head
__ ^ ^ ^
P = a x i + by j + c z k
x
__ y
P=
z
w
Fig. 2.4 Representation of a vector in
space
Chapter 2
Robot Kinematics: Position Analysis
2.3 MATRIX REPRESENTATION
2.3.3 Representation of a Frame at the Origin of a Fixed-Reference Frame
nx ox a x
F = n y o y a y
nz oz a z
nx ox ax Px
n oy ay Py
F= y
nz oz az Pz
0 0 0 1
nx ox ax Px
n oy ay Py
Fobject = y
nz oz az Pz
0 0 0 1
nx ox ax Px
n oy ay Py
F= y
nz oz az Pz
0 0 0 1
Chapter 2
Robot Kinematics: Position Analysis
2.5 REPRESENTATION OF TRANSFORMATINS
2.5.1 Representation of a Pure Translation
1 0 0 dx
0 1 0 d y
T =
0 0 1 dz
0 0 0 1
Fig. 2.9 Representation of an pure translation in space
Chapter 2
Robot Kinematics: Position Analysis
2.5 REPRESENTATION OF TRANSFORMATINS
2.5.2 Representation of a Pure Rotation about an Axis
♦Assumption : The frame is at the origin of the reference frame and parallel to it.
Fig. 2.13 Effects of three successive transformations Fig. 2.14 Changing the order of transformations will
change the final result
Chapter 2
Robot Kinematics: Position Analysis
2.5 REPRESENTATION OF TRANSFORMATINS
2.5.5 Transformations Relative to the Rotating Frame
♦Example 2.8
Fig. 2.16 The Universe, robot, hand, part, and end effecter frames.
Chapter 2
Robot Kinematics: Position Analysis
2.7 FORWARD AND INVERSE KINEMATICS OF ROBOTS
♦Forward Kinematics Analysis:
• Calculating the position and orientation of the hand of the robot.
• If all robot joint variables are known, one can calculate where the robot is
at any instant.
• Recall Chapter 1.
Fig. 2.17 The hand frame of the robot relative to the reference frame.
Chapter 2
Robot Kinematics: Position Analysis
2.7 FORWARD AND INVERSE KINEMATICS OF ROBOTS
2.7.1 Forward and Inverse Kinematics Equations for Position
1 0 0 Px
0 1 0 Py
TP = Tcart
R
=
0 0 1 Pz
0 0 0 1
R
TP = Tcyl (r , α , l ) = Trans(0,0, l )Rot( z , α )Trans(r ,0,0)
Cα − Sα 0 rCα
Sα Cα 0 rSα
R
TP = Tcyl =
0 0 1 l
0 0 0 1
Fig. 2.19 Cylindrical Coordinates.
Chapter 2
Robot Kinematics: Position Analysis
2.7 FORWARD AND INVERSE KINEMATICS OF ROBOTS
2.7.1 Forward and Inverse Kinematics Equations for Position
2.7.1(c) Spherical Coordinates
R
TP = Tsph (r , β , l ) = Rot( z , γ )Rot( y , β )Trans(0,0, γ )
Cβ ⋅ Cγ − Sγ Sβ ⋅ Cγ rSβ ⋅ Cγ
Cβ ⋅ Sγ Cγ Sβ ⋅ Sγ rSβ ⋅ Sγ
TP = Tsph
R
=
− Sβ 0 Cβ rCβ
0 0 0 1
Fig. 2.20 Spherical Coordinates.
Chapter 2
Robot Kinematics: Position Analysis
2.7 FORWARD AND INVERSE KINEMATICS OF ROBOTS
2.7.1 Forward and Inverse Kinematics Equations for Position
2.7.1(d) Articulated Coordinates
R
TH = Tsph (r , β , γ ) × Euler (φ , θ ,ψ )
Denavit-Hartenberg Representation
Chapter 2
Robot Kinematics: Position Analysis
2.8 DENAVIT-HARTENBERG REPRESENTATION OF
FORWARD KINEMATIC EQUATIONS OF ROBOT
• Denavit-Hartenberg Representation :
@ Simple way of modeling robot links and
joints for any robot configuration,
regardless of its sequence or complexity.
Start point:
Assign joint number n to the first shown joint.
Assign a local reference frame for each and every joint before or
skew lines.
٭Parallel z-axes joints make a infinite number of common normal.
٭Intersecting z-axes of two successive joints make no common
normal between them(Length is 0.).
Chapter 2
Robot Kinematics: Position Analysis
2.8 DENAVIT-HARTENBERG REPRESENTATION OF
FORWARD KINEMATIC EQUATIONS OF ROBOT
• Symbol Terminologies :
nz oz az pz
0 0 0 1
Chapter 2
Robot Kinematics: Position Analysis
2.9 THE INVERSE KINEMATIC SOLUTION OF ROBOT
nx ox ax px
p y
−1 n y oy ay
A1 × = A1−1[ RHS ] = A2 A3 A4 A5 A6
nz oz az pz
0 0 0 1
C1 S1 0 0 n x ox ax px
0 0 1 0 n y oy ay p y
× = A2 A3 A4 A5 A6
S1 − C1 0 0 n z oz az pz
0 0 0 1 0 0 0 1
Chapter 2
Robot Kinematics: Position Analysis
2.9 THE INVERSE KINEMATIC SOLUTION OF ROBOT
py
θ1 = tan −1
px
(C3 a3 + a2 )( p z − S 234 a4 ) − S 3 a3 ( p x C1 + p y S1 − C234 a4 )
θ 2 = tan −1
(C3 a3 + a2 )( p x C1 + p y S1 − C234 a4 ) + S 3 a3 ( Pz − S 234 a4 )
S3
θ 3 = tan −1
C3
θ 4 = θ 234 − θ 2 − θ 3
# θ d a α
1 θ1 0 0 -90
2 θ2 d1 0 90
3 0 d1 0 0
4 θ4 0 0 -90
5 θ5 0 0 90
6 θ6 0 0 0
Fig. 2.31 The frames of the Stanford Arm.