You are on page 1of 45

# 6.

Basic Coordinates
Rotation and Translation in basic of Robot Coordinates, Homogeneous
g Transform
Euler Angles, Denavit-Hartenberg Notation

## Affiliated Professor : Jaeyoung Lee

E-mail : biocontrolsys@hotmail.com
H P : 011 – 9455 - 5277
H.P
한국 IT직업전문학교

Topics
p

 Basic Coordinates
 Coordinate Frames & Denavit-Hartenberg
Denavit Hartenberg Notation
 Forward and Inverse Kinematics of Robot Manipulators
 Manipulator
p Jacobian
 Review of Lagrangian Dynamics
 Lagrangian Dynamics of Robot Manipulators
 Newton-Euler Equations of Robot Manipuators
 Forward and Inverse Dynamics
 Robot Statics
 Robot Trajectory Planning
 Robot Control

로봇공학개론 2
한국 IT직업전문학교

Basic Coordinates

##  Operators for Translation and Rotation

- Translation - Rotation

로봇공학개론 3
한국 IT직업전문학교

Basic Coordinate

 Coordinate Frames
- Translation - Rotation

로봇공학개론 4
한국 IT직업전문학교

Basic Coordinate

##  Different View Based Upon Different Coordinates

- Translation - Rotation

로봇공학개론 5
한국 IT직업전문학교

Basic Coordinate

##  Rotation and Translation Combined

- A single rotation after a single translation:

## - A single rotation and a single translation after another pair of

translation and rotation:

## - Scheme shown above to represent transform operations is not a

good way of simplifying notation and computations.

## - We need consistent transforms for translations and rotations:

homogeneous transform

로봇공학개론 6
한국 IT직업전문학교

Basic Coordinate

 Rotation Matrix R

## - Vector p can be represented with respect to the

two different coordinates, i.e., coordinate A and B

## - Noting that x_A, y_A and z_A represent the

components of p along the x, y, and z axes of
coordinate A.

로봇공학개론 7
한국 IT직업전문학교

Basic Coordinate

 Rotation Matrix R
- Noting that x_A,
x A, y_A
y A and z_A
z A represent the components of p along the x, y, and z
axes of coordinate A.

- Therefore,

로봇공학개론 8
한국 IT직업전문학교

Basic Coordinate

 Rotation Matrix R
- Therefore,

- Similarly,

- Thus, Therefore,

## - Rotational matrix R is orthonormal (orthogonal).

로봇공학개론 9
한국 IT직업전문학교

Basic Coordinate

 Homogeneous Transform
- In homogeneous transforms, translation and orientations have identical
characteristics.
- Position vector [x y z]T is represented by an augmented vector [x y z 1]T .
- Translation is represented by a matrix:

로봇공학개론 10
한국 IT직업전문학교

Basic Coordinate
- Rotation is represented by a matrix:

로봇공학개론 11
한국 IT직업전문학교

Basic Coordinate
- If translation and rotation are combined

로봇공학개론 12
한국 IT직업전문학교

Basic Coordinate
- If translation and rotation are combined

Therefore,

로봇공학개론 13
한국 IT직업전문학교

Basic Coordinate

##  More On Rotation : Euler Angles

- Many different sets of Euler angles exist
- Z-Y-Z, Z-Y-X, and etc,
- Example : Z-Y-X : Rotate around z-axis, and then around y-axis, and finally
around x-axis
x axis.

로봇공학개론 14
한국 IT직업전문학교

Basic Coordinate

로봇공학개론 15
한국 IT직업전문학교

Basic Coordinate

##  More On Rotation : Euler Angles

- X-Y-Z
X Y Z Fixed Angles (Pitch-Yaw-Roll)
(Pitch Yaw Roll)

- Note

## - Rotational Transformation (Pre

(Pre-multiplicatin)
multiplicatin)

로봇공학개론 16
한국 IT직업전문학교

Basic Coordinate

 Equivalent Angle-Axis
- Represented by a unit vector that indicates the axis of rotation and an angle to
rotate.
- If the axis of rotation is k = [K_x K_y K_z]^T,

로봇공학개론 17
한국 IT직업전문학교

Basic Coordinate

 Denavit-Hartenberg Notation

- Conventions
Frame i is fixed at (attached to) link i and located at the distal joint, which means
that frame i is located at joint i+1.
Z-axes are aligned with joint axes.

로봇공학개론 18
한국 IT직업전문학교

Basic Coordinate

Length(L n): the shortest distance between two joint axes at both
- Link Twist(alpha_n): "twist" angle of two z-axes at both ends of Link n
in the direction of x_n
x n -axis
axis.
- Link Offset (d_n): distance from the origins of Frame n-1 to Frame n in
the direction of Z_n-1-axis.
- Joint
i Angle(Thetat_n):
l h angle
l ffrom x_n-1-axis
1 i to x_n -axis
i iin the
h direction
di i
of z_n-1-axis.

로봇공학개론 19
한국 IT직업전문학교

Basic Coordinate

 Miscellaneous Conventions
- If z-axes
z axes meet each other,
other x_n
x n – axis,
axis in general,
general is defined to be zz_n
n-
1Ⅹz_n.

## - Positive direction of z-axis can be either.

로봇공학개론 20
한국 IT직업전문학교

Basic Coordinate

 Miscellaneous Conventions
- The origin of frame 0 is usually coincide with that of frame 1.
1
- Z-axis of frame 0 is aligned with z-axis of joint 1.
- For a prismatic joint, z-axis is aligned with the sliding direction of the
j i IIn this
li k offset
ff d iis the
h jjoint
i variable.
i bl
- Homogeneous transform :

coordinates
d in most cases.

로봇공학개론 21
한국 IT직업전문학교

Basic Coordinate

 Example :

로봇공학개론 22
한국 IT직업전문학교

Basic Coordinate

 Example :

Note that
h T^0_1 can be
b directly
d l determined
d d

로봇공학개론 23
한국 IT직업전문학교

## Kinematics & Inverse Kinematics

 Forward Kinematics

## - For a given set of joint displacements, the end-effector position and

orientation can be calculated. (Forward Kinematics)

 Inverse Kinematics
- For a given set of end-effector position
and orientation, joint displacements are
computed.
- We have to solve nonlinear equations;
however, we may not able to solve for
solutions analytically.

로봇공학개론 24
한국 IT직업전문학교

##  Kinematics & Inverse Kinematics for a 2-D Revolute-Jointed Manipulator

Forward Kinematics

로봇공학개론 25
한국 IT직업전문학교

F
Forward
d Kinematics
Ki ti

로봇공학개론 26
한국 IT직업전문학교

##  Kinematics & Inverse Kinematics for a 2-D Revolute-Jointed Manipulator

E d Eff t P
End-Effector Position
iti End-Effector Orientation

로봇공학개론 27
한국 IT직업전문학교

##  Kinematics & Inverse Kinematics for a 2-D Revolute-Jointed Manipulator

Inverse Kinematics
- For a given tip position [x y]^T, the joint displacement [theta_1 theta_2]^T
is to be determined.

Geometric Method
(Using cosine rule)

로봇공학개론 28
한국 IT직업전문학교

##  Kinematics & Inverse Kinematics for a 2-D Revolute-Jointed Manipulator

Inverse Kinematics

로봇공학개론 29
한국 IT직업전문학교

##  Kinematics & Inverse Kinematics for a 2-D Revolute-Jointed Manipulator

Inverse Kinematics

로봇공학개론 30
한국 IT직업전문학교

##  Kinematics & Inverse Kinematics for a 2-D Revolute-Jointed Manipulator

Inverse Kinematics

Sign: "+", if -p < theta_2 < 0, i.e., at "elbow up“ configuration "-", otherwise.

로봇공학개론 31
한국 IT직업전문학교

Algebraic Method

## left hand side: a constant matrix

left-hand-side:
right-hand-side: a matrix whose elements are functions of joint angles

로봇공학개론 32
한국 IT직업전문학교

Algebraic Method

로봇공학개론 33
한국 IT직업전문학교

Algebraic Method

Let

Then

로봇공학개론 34
한국 IT직업전문학교

Algebraic Method
Similarly,

Using
g

로봇공학개론 35
한국 IT직업전문학교

Algebraic Method
where

Therefore,

로봇공학개론 36
한국 IT직업전문학교

## Kinematics & Inverse Kinematics

 Kinematic Decoupling
If the final 3 consecutive axes meet at a point, the process of solving inverse
kinematics is simplified.

## Three axes z4 , z5 , and z6

meet at a wrist center
center.

## The position of the wrist center, w, is determined

by q1, q2 , and q3 only.

로봇공학개론 37
한국 IT직업전문학교

## Kinematics & Inverse Kinematics

 Kinematic Decoupling
- From the target tool position d and orientation R, wrist center
position can be computed:

where
h

- Once the wrist center is known, the first 3 joint variables, q1, q2, and q3 , can
be computed.

- The orientation matrix R^0_3 can be computed after q1, q2 , and q3 are
d t
determined.
i d

## - The rest of joint variables, q 4, q5 , and q6 , can be computed from R_6^3,

which in turn can be computed by

로봇공학개론 38
한국 IT직업전문학교

 SCARA Robot

로봇공학개론 39
한국 IT직업전문학교

 SCARA Robot

로봇공학개론 40
한국 IT직업전문학교

## Kinematics & Inverse Kinematics

 SCARA Robot
- Rotation matrix R can be in the form of

로봇공학개론 41
한국 IT직업전문학교

## Kinematics & Inverse Kinematics

 SCARA Robot
- Using a geometry formed by projecting the manipulator configuration
upon a horizontal plane, which forms a 2-link manipulator,

- and

로봇공학개론 42
한국 IT직업전문학교

## Kinematics & Inverse Kinematics

 SCARA Robot
- Solvability : A manipulator is defined to be solvable, if all the sets of joint variables
for a given position and orientation can be determined by an algorithm. Many
manipulators have multiple solutions for a single configuration. For example,
PUMA 560 has 8 solutions.
-W
Workspace
k : The
Th volume
l off space that
h the
h end-effector
d ff off a manipulator
i l can reach.
h
Within the workspace, inverse kinematics solutions exist.
- Closed Form Solution : Inverse kinematic solutions can be grouped into closed form
solutions and numerical solutions.
solutions Closed form solutions are noniterative such as
algebraic expressions; whereas numerical solutions are iterative. Numerical
solutions are computationally more expensive and slower.
p
- Pieper's work : A g
general 6 d.o.f. manipulator
p does not have a closed form solution.
If the three consecutive axies intersect at a point, a closed form solution exists. For
most commercial manipulators, the last consecutive axes intersect at a point.
- Notes: Even if inverse kinematic solutions are found, they may not be physically
realizable due to joint angle limitations
limitations.

로봇공학개론 43
한국 IT직업전문학교

HW 6

 139p, 연습문제 1

로봇공학개론 44
한국 IT직업전문학교

REFERENCE

 기초로봇 공학
- 제 2편 : 로봇 제어의 시작

##  Introduction to Robotics,, byy J,, J. Craig

g
- Ch 2. Spatial descriptions and transformations
- Ch 3. Manipulator kinematics
- Ch 4. Inverse manipulator kinematics

로봇공학개론 45