Cse5410 4
Cse5410 4
Control
Lecture. 4 (Chap. 5)
Fall, 2022
Instructor :
DuckJin Chung,Ph. D.
1
1) Introduction: Chap.1
- Robot Components
- Introduction to Robot’s Kinematics, Dynamics, and Control
2) Rotation Kinematics: Chap. 2
- Rotation about Global Cartesian Axes
- Rotation About Local Cartesian Axes
3) Motion Kinematics: Chap. 4
- Rigid Body Motion
- Homogeneous Transformation
4) Forward Kinematics: Chap. 5
- Denavit-Hartenberg Notation
-Transformation between Two Adjacent Coordinate Frames
5) Inverse Kinematics: Chap. 6
- Decoupling Technique
- Inverse Transformation
6) Path Planning: Chap. 13
- Cubic Path
2
--Polynomial path
Chapter 5. Forward Kinematics
3
5.1. Denavit-Hartenberg Notation
4
5
5.1. Denavit-Hartenberg Notation
6
5.1. Denavit-Hartenberg Notation
7
5.2. Transformation Between Two Adjacent Coordinate Frames
8
5.2. Transformation Between Two Adjacent Coordinate Frames
9
Therefore the transformation equation from coordinate frame Bi(xi, yi,
Zi) to its previous coordinate frame Bi-1(xi-1, yi-1, zi-1) , is
10
11
Proof. 1
12
Proof 1
13
14
Proof 2
15
Proof 2
16
Ex. 141 DH transformation matrices for 2r Planar manipulator
17
Ex. 141 DH transformation matrices for 2r Planar manipulator
18
Ex. 142 Link with R||R or R||P joint
( αi = 0 deg)
19
Ex. 142 Link with R||R or R||P joint
( αi = 180 deg)
20
Ex. 143 Link with R R or R P joint
( αi = 90 deg.)
21
Ex. 143 Link with R R or R P joint
( αi = -90 deg.)
22
Ex. 144 Link with R R or R P joint
( αi = 90 deg. ai = 0)
23
Ex. 144 Link with R R or R P joint
( αi = -90 deg. ai = 0)
24
5.3. Forward Position Kinematics of Robots
Finding the end-effector position and orientation for a given set of joint
variables is the main problem in forward kinematics. For a six DOF robot,
six DH transformation matrices, one for each link, are required to
transform the final coordinates to the base coordinates. The last frame
attached to the final frame is usually set at the center of the gripper. The
position and orientation of the end-effector is also a unique function of
the joint variables.
25
Ex. 154 3R planar manipulator forward kinematics
26
Ex. 154 3R planar manipulator forward kinematics
27
Ex. 154 3R planar manipulator forward kinematics
28
Ex. 155 articulated arm forward kinematics
29
Ex. 144 Link with R R or R P joint
( αi = -90 deg. ai = 0)
30
Ex. 142 Link with R||R or R||P joint
( αi = 0 deg)
31
Ex. 144 Link with R R or R P joint
( αi = 90 deg. ai = 0)
32
33
Ex. 156 An articulated arm kinematics
34
35
Ex. 157 Working sp ace
36