robot1
robot1
Introduction to Robotics 4 C1. Overviews and Fundamentals Introduction to Robotics 2 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 7 C1. Overviews and Fundamentals Introduction to Robotics 5 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 8 C1. Overviews and Fundamentals Introduction to Robotics 6 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 11 C1. Overviews and Fundamentals Introduction to Robotics 9 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 12 C1. Overviews and Fundamentals Introduction to Robotics 10 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 15 C1. Overviews and Fundamentals Introduction to Robotics 13 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 16 C1. Overviews and Fundamentals Introduction to Robotics 14 C1. Overviews and Fundamentals
Model of 3R manipulator Symbol of Revolute joint and Prismatic joint in robot model
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 20 C1. Overviews and Fundamentals Introduction to Robotics 18 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 23 C1. Overviews and Fundamentals Introduction to Robotics 21 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 24 C1. Overviews and Fundamentals Introduction to Robotics 22 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 27 C1. Overviews and Fundamentals Introduction to Robotics 25 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 28 C1. Overviews and Fundamentals Introduction to Robotics 26 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 31 C1. Overviews and Fundamentals Introduction to Robotics 29 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 32 C1. Overviews and Fundamentals Introduction to Robotics 30 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 35 C1. Overviews and Fundamentals Introduction to Robotics 33 C1. Overviews and Fundamentals
[Link video]
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 36 C1. Overviews and Fundamentals Introduction to Robotics 34 C1. Overviews and Fundamentals
▪ the axes of two adjacent joints can be parallel (∥), orthogonal A delta robot is a type of parallel robot that consists of three
(⊢), or perpendicular (⊥). arms connected to universal joints at the base.
[Link video]
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 39 C1. Overviews and Fundamentals Introduction to Robotics 37 C1. Overviews and Fundamentals
Introduction to Robotics 40 C1. Overviews and Fundamentals Introduction to Robotics 38 C1. Overviews and Fundamentals
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 44 C1. Overviews and Fundamentals Introduction to Robotics 42 C1. Overviews and Fundamentals
frames is determined a
A rotated body frame B in a fixed transformation
global frame G, about a fixed point at O matrices.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
G
r2 = Q Z,α Br2
⇒ Two frames are related as follows:
cos − sin 0
Q Z,α = sin cos 0
0 0 1
HCMUTE, Faculty of Mechanical Engineering
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien Department of Mechatronics
Introduction to Robotics 6 C2. Rotation Kinematics Introduction to Robotics 4 C2. Rotation Kinematics
2.1. Rotation About Global Cartesian Axes 2.1. Rotation About Global Cartesian Axes
Example 1: Successive rotation about global axes. Y-axis of the global coordinate frame
The final position of the corner P (5, 30, 10) of the slab after
• Similarly, rotation β degrees about the Y–axis of the global
30 [deg] rotation about the Z-axis, followed by 30 [deg] about the
frame relate the local and global coordinates.
X-axis, and then 90 [deg] about the Y-axis. Can find the final global T
position of the corner P? • Consider point P: B r = x y z
G
r = Q Y,β Br
where QY, is the Y-rotation matrix
cos 0 sin
Q Y,β = 0 1 0
− sin 0 cos
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 7 C2. Rotation Kinematics Introduction to Robotics 5 C2. Rotation Kinematics
2.1. Rotation About Global Cartesian Axes 2.1. Rotation About Global Cartesian Axes
Example 1: Successive rotation about global axes. X-axis of the global coordinate frame
• Finally, rotation γ degrees about the X–axis of the global frame
G B relate the local and global coordinates.
r2 = Q Z,α r2
T
• Consider point P: B r = x y z
G
r = Q X,γ Br
G
r = Q X,γ Br
where QX, is the X-rotation matrix
1 0 0
G B
r = Q Y,β r Q X,γ = 0 cos − sin
0 sin cos
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 10 C2. Rotation Kinematics Introduction to Robotics 8 C2. Rotation Kinematics
2.2. Successive Rotation About Global Cartesian Axes 2.1. Rotation About Global Cartesian Axes
A sequence of rotations Example 1: Successive rotation about global axes.
• The final global position of a point P in a rigid body B with
position vector r, after a sequence of rotations Q1, Q2, Q3, ..., Qn
about the global axes can be found by
G
r = G QB Br
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 11 C2. Rotation Kinematics Introduction to Robotics 9 C2. Rotation Kinematics
2.2. Successive Rotation About Global Cartesian Axes 2.1. Rotation About Global Cartesian Axes
Example 3: Successive global rotation matrix. Example 2: Global rotation, local position.
• The global rotation matrix after a rotation QZ,α followed by QY,β A point P is moved to Gr2 = [4, 3, 2]T after a 60 [deg]
and then QX,γ is:? rotation about the Z-axis. Find its position in the local coordinate?
G
Q B = Q X , QY , Q Z ,
1 0 0 cos 0 sin cos − sin 0 G
G r2 = Q Z,α Br2
Q B = 0 cos − sin 0 1 0 sin cos 0
−1 G
0 sin cos − sin 0 cos 0 0 1 Br2 = Q Z,α r2
c c −c s s B
G
r2 = Q -1Z,60G r2
Q B = c s + c s s c c − s s s −c s
s s − c c s c s + c s s c c
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 14 C2. Rotation Kinematics Introduction to Robotics 12 C2. Rotation Kinematics
2.2. Successive Rotation About Global Cartesian Axes 2.2. Successive Rotation About Global Cartesian Axes
Twelve independent triple global rotations Example 4: Successive global rotations, global
• We may transform its body coordinate frame B from the position.
coincident position with a global frame G to any final orientation
• The end point P = [X1 Y1 Z1]T
by only three rotations about the global axes provided that no two
of the arm shown in Figure.
consequence rotations are about the same axis. In general, there
are 12 different independent combinations of triple rotations • The rotation matrix to find the
about the global axes. new position of the end point
after −29 [deg] rotation about
the X-axis, followed by 30 [deg]
about the Z-axis, and again 132
[deg] about the X-axis.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 15 C2. Rotation Kinematics Introduction to Robotics 13 C2. Rotation Kinematics
2.2. Successive Rotation About Global Cartesian Axes 2.2. Successive Rotation About Global Cartesian Axes
Global roll, pitch, and yaw rotations Example 4: Successive global rotations, global
The rotation about the X-axis of the global coordinate frame is position.
called a roll, the rotation about the Y-axis is called a pitch, and the
rotation about the Z-axis is called a yaw. The global rotation matrix is
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 18 C2. Rotation Kinematics Introduction to Robotics 16 C2. Rotation Kinematics
2.3. Rotation About Local Cartesian Axes 2.3. Rotation About Local Cartesian Axes
Example 5: Local rotation, local position. Local z-axis of the local coordinate frame
rotation, global position. • Consider a rigid body B with a local coordinate frame B (Oxyz)
that is originally coincident with a global coordinate frame G
(OXYZ).
• The body undergoes a rotation φ about the z-axis of its local
coordinate frame.
B
r = A z,φ G r
⇒ Two frames are related as follows:
cos sin 0
A z,φ = − sin cos 0
0 0 1
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 19 C2. Rotation Kinematics Introduction to Robotics 17 C2. Rotation Kinematics
2.3. Rotation About Local Cartesian Axes 2.3. Rotation About Local Cartesian Axes
Example 5: Local rotation, local position. Local x,y-axes of the local coordinate frame
rotation, global position. Similarly, rotation θ about the y-axis and rotation ψ about the x-
axis of the local frame relate the local and global coordinates of
If a local coordinate frame Oxyz has been rotated 60 [deg] about the
point P by the following equations
z-axis and a point P in the local coordinate frame Oxyz is at (4, 3, 2)
B
r = A y , G r
B
r = A x , G r
⇒ its position in the global coordinate frame OXYZ is at
where Ay,θ is the y-rotation matrix and Ax,ψ is the x-rotation matrix
cos 0 − sin 1 0 0
A y , = 0 1 0 A x ,
= 0 cos sin
sin 0 cos 0 − sin cos
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 22 C2. Rotation Kinematics Introduction to Robotics 20 C2. Rotation Kinematics
2.4. Successive Rotation About Local Cartesian Axes 2.3. Rotation About Local Cartesian Axes
Example 7: Successive local rotation, local position. Example 6: Successive local rotation, global position.
A local coordinate frame B(Oxyz) that initially is coincident with a The first actuator rotates the arm −90 [deg] about y-axis, and then
global coordinate frame G(OXYZ) undergoes a rotation φ = 30 [deg] the second actuator rotates the arm 90 [deg] about x-axis. If, before
about the z-axis, then θ = 30 [deg] about the x-axis, and then ψ = 30 the rotations, the end point P is at BrP = [9.5 -10.1 10.1]T
[deg] about the y-axis. The local coordinates of a point P located at
X = 5, Y = 30, and Z = 10 can be found?
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 23 C2. Rotation Kinematics Introduction to Robotics 21 C2. Rotation Kinematics
2.4. Successive Rotation About Local Cartesian Axes 2.4. Successive Rotation About Local Cartesian Axes
Twelve independent rotation about local axes A sequence of rotations
• We may transform a body coordinate frame B from the coincident • Consider a point P in a rigid body B(Oxyz) at position vector r.
position with a global frame G to any final orientation by Having the final global position vector Gr of P , we can determine
minimum three rotations about the local axes provided that no two its local position vector Br after a series of sequential rotations A1,
consequence rotations are about the same axis. In general, there A2, A3, . . ., An about the local axes, by
are 12 different independent combinations of triple rotation about B
r = B AG Gr
local axes.
where the local rotation matrix,
B
A G = A n ...A 3 A 2 A1
A 3 A 2 A1 = A 3 A 2 A1 = A 3 A 2 A1
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 26 C2. Rotation Kinematics Introduction to Robotics 24 C2. Rotation Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 27 C2. Rotation Kinematics Introduction to Robotics 25 C2. Rotation Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 30 C2. Rotation Kinematics Introduction to Robotics 28 C2. Rotation Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 31 C2. Rotation Kinematics Introduction to Robotics 29 C2. Rotation Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 3 C3. Orientation Kinematics
Introduction to Robotics
3.1. Axis–Angle Rotation
• Assume a body frame B (Oxyz) rotates ϕ about a line indicated by a
unit vector û with direction cosines u1, u2, u3.
T
uˆ = u1Iˆ + u2 Jˆ + u3 Kˆ = u1 u2 u3
u12 + u22 + u32 = 1
Chapter 3. Orientation Kinematics
• Two parameters are necessary to define the unit vector û through O, and Dr. Tran Minh Thien
⇒ This is called axis–angle representation of a rotation.
one is necessary to define the amount of rotation ϕ of the rigid body about
û.
Introduction to Robotics 4 C3. Orientation Kinematics Introduction to Robotics 2 C3. Orientation Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 7 C3. Orientation Kinematics Introduction to Robotics 5 C3. Orientation Kinematics
• Given a transformation matrix GRB we can obtain the axis û and angle ϕ of
the rotation by
where,
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 8 C3. Orientation Kinematics Introduction to Robotics 6 C3. Orientation Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics
⇒ which is equivalent to the rotation matrix about the Z-axis of global frame.
• We may verify the angle-axis rotation formula and derive the same
rotation matrix
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 12 C3. Orientation Kinematics Introduction to Robotics 10 C3. Orientation Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 15 C3. Orientation Kinematics Introduction to Robotics 13 C3. Orientation Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 16 C3. Orientation Kinematics Introduction to Robotics 14 C3. Orientation Kinematics
Or
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 19 C3. Orientation Kinematics Introduction to Robotics 17 C3. Orientation Kinematics
Case 1
Case 2
Case 3
Case 4
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 20 C3. Orientation Kinematics Introduction to Robotics 18 C3. Orientation Kinematics
3.3. Exercises
C3. End!
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 3 C4. Motion Kinematics
Introduction to Robotics
4.1. Rigid Body Motion
The displacement or translation
Consider a rigid body with an attached body coordinate frame B
(oxyz) moving in a fixed global coordinate frame G(OXYZ).
• The displacement vector Gd indicates the position of the moving
origin o relative to the fixed origin O, then the coordinates of a Chapter 4. Motion Kinematics
body point P in local and global frames are related by
G
rP = G R B B rP + G d
Dr. Tran Minh Thien
where,
Introduction to Robotics 4 C4. Motion Kinematics Introduction to Robotics 2 C4. Motion Kinematics
4.1. Rigid Body Motion • The most general motion of a rigid body B in a global frame G is
Example 1: Translation and rotation of a body made by a rotation ϕ about an axis û (vector), plus a displacement
coordinate frame d.
• The rigid body motion may be expressed by a 3×3 rotation matrix
A body coordinate frame B(oxyz), that is originally coincident with
plus a 3×1 displacement vector.
global coordinate frame G(OXYZ), rotates 45 [deg] about the X-axis and
translates to [3 5 7]T . Find, the global position of a point at Br = [x y z]T. • Expressing by a 4 × 4 homogenous transformation matrix.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 8 C4. Motion Kinematics Introduction to Robotics 6 C4. Motion Kinematics
Y, and 0.2 along the Z axes. Find the position GrP of P in global
at 𝐺𝑟𝑃1 = 𝐵𝑟𝑃1 = 1350 0 900 𝑇 mm. The arm rotates 60 [deg] about the
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 13 C4. Motion Kinematics Introduction to Robotics 11 C4. Motion Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 14 C4. Motion Kinematics Introduction to Robotics 12 C4. Motion Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 20 C4. Motion Kinematics Introduction to Robotics 15 C4. Motion Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 21 C4. Motion Kinematics Introduction to Robotics 19 C4. Motion Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 24 C4. Motion Kinematics Introduction to Robotics 22 C4. Motion Kinematics
4.3. Inverse and Reverse Homogenous Transformation 4.3. Inverse and Reverse Homogenous Transformation
Quick inverse transformation
The reverse motion of GTB would be GT−B
Decompose a transformation matrix into rotation [R] and
displacement [D] and take advantage of the inverse of matrix
multiplication.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 25 C4. Motion Kinematics Introduction to Robotics 23 C4. Motion Kinematics
4.4. Combined Homogenous Transformation 4.3. Inverse and Reverse Homogenous Transformation
The transformation matrices to transform coordinates from frame Example 8: Inverse of a homogenous transformation
B to A and from frame C to B are
matrix
Assume that
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 28 C4. Motion Kinematics Introduction to Robotics 26 C4. Motion Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 29 C4. Motion Kinematics Introduction to Robotics 27 C4. Motion Kinematics
Rather than
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 32 C4. Motion Kinematics Introduction to Robotics 30 C4. Motion Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 33 C4. Motion Kinematics Introduction to Robotics 31 C4. Motion Kinematics
where,
C4. End!
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 6 C5. Forward Kinematics Introduction to Robotics 4 C5. Forward Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 9 C5. Forward Kinematics Introduction to Robotics 7 C5. Forward Kinematics
axis, from zi−1 to zi axes. • The xi-axis is defined along the common normal between the zi−1
and zi axes, pointing from the zi−1 to the zi-axis.
axis. ai is the kinematic length of the link (i). ⇒ i is along the xi-
2. Link twist i (alpha) is the required rotation of the zi−1 -axis about
• The yi-axis is determined by the right-hand rule, yi = zi × xi.
axis, from zi−1 to zi axes.
the xi-axis to become parallel to the zi -axis. ⇒ i is about the xi-
3. Joint distance di is the distance between xi−1 and xi axes along the
zi), attached to the link (i), is placed at the intersection of the joint
⇒ By applying the DH method, the origin oi of the frame Bi (oi, xi, yi,
axis i + 1 with the common normal between the zi−1 and zi axes.
zi−1-axis, from xi−1 to xi axes.
zi−1-axis. Joint distance is also called link offset. ⇒ di is along the
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 10 C5. Forward Kinematics Introduction to Robotics 8 C5. Forward Kinematics
• The parameters θi and di are called joint parameters, defining the • A DH coordinate frame is identified by four parameters: ai, αi, θi,
relative position of two adjacent links connected at joint i. and di.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 13 C5. Forward Kinematics Introduction to Robotics 11 C5. Forward Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 14 C5. Forward Kinematics Introduction to Robotics 12 C5. Forward Kinematics
3 l3 0 0
𝜃2
𝜃3
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 17 C5. Forward Kinematics Introduction to Robotics 15 C5. Forward Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 18 C5. Forward Kinematics Introduction to Robotics 16 C5. Forward Kinematics
5.2. Transformation Between Adjacent Coordinate Frames 5.2. Transformation Between Adjacent Coordinate Frames
• The coordinate frame Bi is fixed to the link (i) and the coordinate
frame Bi−1 is fixed to the link (i − 1).
• The following prescribed set of two rotations and two translations
is also a straightforward method to move the frame Bi−1 to coincide
with the frame Bi. This is a method to make a transformation
• Therefore, the transformation equation from coordinate frame Bi(xi, matrix iTi−1:
yi, zi), to its previous coordinate frame Bi−1(xi−1, yi−1, zi−1), is 1. Translate frame Bi−1 along the zi−1 -axis by distance di.
2. Rotate frame Bi−1 through θi around the zi−1 -axis.
3. Translate frame Bi−1 along the xi-axis by distance ai.
4. Rotate frame Bi−1 through αi about the xi-axis.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 22 C5. Forward Kinematics Introduction to Robotics 19 C5. Forward Kinematics
5.2. Transformation Between Adjacent Coordinate Frames 5.2. Transformation Between Adjacent Coordinate Frames
Example 5: DH application for spherical robot. !?
Figure illustrates a spherical manipulator equipped with a spherical
wrist. A spherical manipulator is an R⊢R⊢P arm. • The inverse of the homogenous transformation matrix is
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 23 C5. Forward Kinematics Introduction to Robotics 20 C5. Forward Kinematics
5.2. Transformation Between Adjacent Coordinate Frames 5.2. Transformation Between Adjacent Coordinate Frames
Example 5: DH application for spherical robot. !? Example 4: DH transformation matrices for a 2R
The homogenous transformation matrices are planar manipulator.
Figure illustrates an R||R planar manipulator and its DH link
coordinate frames.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 27 C5. Forward Kinematics Introduction to Robotics 25 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.2. Transformation Between Adjacent Coordinate Frames
• For an n-DOF robot, at least n transformation matrices, one for
every link, are required to determine the global coordinate of any A closed-loop robot provides a constraint on transformation
point in any frame. matrices,
• The configuration of the multibody when all the joint variables are
zero is called the rest position.
where, the transformation matrix [T] contains elements that are
functions of a2, d, a3, θ3, a4, θ4, θ1. The parameters a2, a3, and a4 are
constant, while d, θ3, θ4, θ1 are variables.
Assuming θ1 is input and specified, we may solve for other
unknown variables θ3, θ4, d by equating the corresponding elements of
[T] and I.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 28 C5. Forward Kinematics Introduction to Robotics 26 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.3. Forward Position Kinematics of Robots
• The forward or direct kinematics is the transformation of
kinematic information from the robot joint variable space to the
• If the links of a robot are arranged such that every link (i) has only Cartesian coordinate space.
one coordinate frame Bi and the frames are arranged sequentially,
then:
given set of joint variables is the main problem in forward
⇒ Determining the end-effector position and orientation for a
kinematics.
• Determine the coordinates of any point P of link (i) in the base frame kinematic information of link (i) in the base link coordinate frame.
⇒ Determining transformation matrices 0Ti to express the
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 34 C5. Forward Kinematics Introduction to Robotics 29 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.3. Forward Position Kinematics of Robots
Example 9: R||R||R, planar manipulator forward Example 7: A 2R planar manipulator. !?
kinematics. Figure illustrates a 2R or R||R planar manipulator with two parallel
The transformation matrices i−1Ti for i = 3, 2, 1 can be found revolute joints. Find, the transformation matrices 0T1, 1T2, 0T2
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 35 C5. Forward Kinematics Introduction to Robotics 33 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.3. Forward Position Kinematics of Robots
Example 9: R||R||R, planar manipulator forward Example 9: R||R||R, planar manipulator forward
kinematics. kinematics.
The transformation matrices i−1Ti for i = 3, 2, 1 can be found Application of DH matrices in forward kinematic analysis of a
planar 3 DOF robot.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 38 C5. Forward Kinematics Introduction to Robotics 36 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.3. Forward Position Kinematics of Robots
Example 10: 3R, R R||R, articulated arm forward Example 9: R||R||R, planar manipulator forward
kinematics. kinematics.
How to determine forward kinematics of the robot? The origin of the frame B3 is the tip point of the robot. Its position is
at
It means we can find the coordinate of the tip point in the base
Cartesian coordinate frame
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 39 C5. Forward Kinematics Introduction to Robotics 37 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.3. Forward Position Kinematics of Robots
Example 10: 3R, R R||R. Example 9: R||R||R, planar manipulator forward
kinematics.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 42 C5. Forward Kinematics Introduction to Robotics 40 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.3. Forward Position Kinematics of Robots
Example 10: 3R, R R||R. Example 10: 3R, R R||R.
The tip point P of the third arm is at 3rP = [0 0 l3]T in B3 The successive transformation matrices have the following
expressions:
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 43 C5. Forward Kinematics Introduction to Robotics 41 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.3. Forward Position Kinematics of Robots
Example 10: 3R, R R||R. Example 10: 3R, R R||R.
The tip point P of the third arm is at in B3 To express the complete forward kinematics transformation:
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 46 C5. Forward Kinematics Introduction to Robotics 44 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.3. Forward Position Kinematics of Robots
Example 11: SCARA robot (R||R||R||P). Example 11: SCARA robot (R||R||R||P).
The third link is an R||R(0) with zero length, Consider the R||R||R||P robot shown in Figure.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 47 C5. Forward Kinematics Introduction to Robotics 45 C5. Forward Kinematics
5.3. Forward Position Kinematics of Robots 5.3. Forward Position Kinematics of Robots
Example 11: SCARA robot (R||R||R||P). Example 11: SCARA robot (R||R||R||P).
The configuration of the end-effector in the base coordinate frame The first link is an R||R(0), which has the following transformation
is matrix:
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 50 C5. Forward Kinematics Introduction to Robotics 48 C5. Forward Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 51 C5. Forward Kinematics Introduction to Robotics 49 C5. Forward Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 54 C5. Forward Kinematics Introduction to Robotics 52 C5. Forward Kinematics
C5. End!
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
6.1. Decoupling Technique • What are the joint variables for a given configuration of a robot?
nonlinear coupled.
• Mathematically, inverse kinematics is searching for the elements of
joint variable vector q, • The main difficulty of inverse kinematic is the multiple solutions.
Introduction to Robotics 5 C6. Inverse Kinematics Introduction to Robotics 3 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 8 C6. Inverse Kinematics Introduction to Robotics 6 C6. Inverse Kinematics
C1: To find θ2, we use The unknown angle θ of the trigonometric equation is:
where,
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 9 C6. Inverse Kinematics Introduction to Robotics 7 C6. Inverse Kinematics
where,
The global position of the tip point of the manipulator is at:
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 12 C6. Inverse Kinematics Introduction to Robotics 10 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 13 C6. Inverse Kinematics Introduction to Robotics 11 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 16 C6. Inverse Kinematics Introduction to Robotics 14 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 17 C6. Inverse Kinematics Introduction to Robotics 15 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 20 C6. Inverse Kinematics Introduction to Robotics 18 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 21 C6. Inverse Kinematics Introduction to Robotics 19 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 24 C6. Inverse Kinematics Introduction to Robotics 22 C6. Inverse Kinematics
Find the orientation of the end-effector by solving 3T6 or 3R6 for θ4,
θ5, θ6 It can be seen that
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 25 C6. Inverse Kinematics Introduction to Robotics 23 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 28 C6. Inverse Kinematics Introduction to Robotics 26 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 29 C6. Inverse Kinematics Introduction to Robotics 27 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 32 C6. Inverse Kinematics Introduction to Robotics 30 C6. Inverse Kinematics
Using the following dimensions: l1= 1m, l2= 1.05m, l3= 0.89m
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 33 C6. Inverse Kinematics Introduction to Robotics 31 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 36 C6. Inverse Kinematics Introduction to Robotics 34 C6. Inverse Kinematics
where,
Having θ2, we can calculate θ3 from the last column
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 37 C6. Inverse Kinematics Introduction to Robotics 35 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 40 C6. Inverse Kinematics Introduction to Robotics 38 C6. Inverse Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 41 C6. Inverse Kinematics Introduction to Robotics 39 C6. Inverse Kinematics
Define
The Jacobian
of the equations
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 44 C6. Inverse Kinematics Introduction to Robotics 42 C6. Inverse Kinematics
Assume,
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 45 C6. Inverse Kinematics Introduction to Robotics 43 C6. Inverse Kinematics
Iteration 2.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 46 C6. Inverse Kinematics
Introduction to Robotics
6.2. Inverse Transformation Technique
Ex 4: Inverse kinematics for a 2R planar
manipulator.
Iteration 3.
The result of the fourth iteration q(4) is close enough to the exact
value q = [ π/2 −π/2]T .
HCMUTE, Faculty of Mechanical Engineering
Department of Mechatronics HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 2 C7. Derivative Kinematics Introduction to Robotics 47 C6. Inverse Kinematics
C6. End!
A rotating rigid body B(Oxyz) with a fixed point O in a global frame G(OXYZ)
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 5 C7. Derivative Kinematics Introduction to Robotics 3 C7. Derivative Kinematics
= t= 30 deg, is
̇ G.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 6 C7. Derivative Kinematics Introduction to Robotics 4 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 9 C7. Derivative Kinematics Introduction to Robotics 7 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 10 C7. Derivative Kinematics Introduction to Robotics 8 C7. Derivative Kinematics
where GdB indicates the position of the moving origin o relative to the
fixed origin O.
• The velocity of the point P in G is
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 15 C7. Derivative Kinematics Introduction to Robotics 13 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 16 C7. Derivative Kinematics Introduction to Robotics 14 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 19 C7. Derivative Kinematics Introduction to Robotics 17 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 20 C7. Derivative Kinematics Introduction to Robotics 18 C7. Derivative Kinematics
where 0V2 is
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 23 C7. Derivative Kinematics Introduction to Robotics 21 C7. Derivative Kinematics
• Its derivative is
where
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 24 C7. Derivative Kinematics Introduction to Robotics 22 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 27 C7. Derivative Kinematics Introduction to Robotics 25 C7. Derivative Kinematics
• The velocity of the origin of Bi-frame attached to link (i) in the base • For two links connected by a prismatic joint is
coordinate frame is
Introduction to Robotics 28 C7. Derivative Kinematics Introduction to Robotics 26 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 31 C7. Derivative Kinematics Introduction to Robotics 29 C7. Derivative Kinematics
effector.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 32 C7. Derivative Kinematics Introduction to Robotics 30 C7. Derivative Kinematics
where the 6×n proportionality matrix J(q) is called the Jacobian matrix
of the robot.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 35 C7. Derivative Kinematics Introduction to Robotics 33 C7. Derivative Kinematics
• Its velocity is
known end-effector speeds vector 𝑿.̇
Introduction to Robotics 36 C7. Derivative Kinematics Introduction to Robotics 34 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 39 C7. Derivative Kinematics Introduction to Robotics 37 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 40 C7. Derivative Kinematics Introduction to Robotics 38 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 43 C7. Derivative Kinematics Introduction to Robotics 41 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 44 C7. Derivative Kinematics Introduction to Robotics 42 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 47 C7. Derivative Kinematics Introduction to Robotics 45 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 48 C7. Derivative Kinematics Introduction to Robotics 46 C7. Derivative Kinematics
• The coordinates of a
body point P in local
where, [J] is the Jacobian matrix, [𝐉]̇ is time derivative of Jacobian
follows
and 𝒒̈ is the joint acceleration vector.
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 51 C7. Derivative Kinematics Introduction to Robotics 49 C7. Derivative Kinematics
acceleration vectors
• 𝑿̇ and 𝑿̈ are the end-effector configuration velocity and
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 52 C7. Derivative Kinematics Introduction to Robotics 50 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 55 C7. Derivative Kinematics Introduction to Robotics 53 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 56 C7. Derivative Kinematics Introduction to Robotics 54 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 59 C7. Derivative Kinematics Introduction to Robotics 57 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 60 C7. Derivative Kinematics Introduction to Robotics 58 C7. Derivative Kinematics
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien
Introduction to Robotics 61 C7. Derivative Kinematics
C7. End!
HCMUTE, Faculty of Mechanical Engineering, Dept. of Mechatronics © Dr. Tran Minh Thien