Professional Documents
Culture Documents
!!! Denavit-Hartenberg Convention
!!! Denavit-Hartenberg Convention
!!! Denavit-Hartenberg Convention
Denavit-Hartenberg Convention
• Number the joints from 1 to n starting with the base and ending with
the end-effector.
• Establish the base coordinate system. Establish a right-handed
orthonormal coordinate system ( X 0 , Y0 , Z 0 ) at the supporting base
with Z 0 axis lying along the axis of motion of joint 1.
• Establish joint axis. Align the Zi with the axis of motion (rotary or
sliding) of joint i+1.
• Establish the origin of the ith coordinate system. Locate the origin of
the ith coordinate at the intersection of the Zi & Zi-1 or at the
intersection of common normal between the Zi & Zi-1 axes and the Zi
axis.
• Establish Xi axis. Establish X i (Zi 1 Zi ) / Zi 1 Zi or along the
common normal between the Zi-1 & Zi axes when they are parallel.
• Establish Yi axis. Assign Yi ( Z i X i ) / Z i X i to complete the
right-handed coordinate system.
• Find the link and joint parameters
Example I
• 3 Revolute Joints
Z3
Z0 Z1
Joint 3
Y0 O3 X3
Y1
Link 1 Link 2 d2
Joint 1
O0 X0 O1 X1 O2 X2
Joint 2
Y2
a0 a1
Link Coordinate Frames
• Assign Link Coordinate Frames:
– To describe the geometry of robot motion, we assign a Cartesian
coordinate frame (Oi, Xi,Yi,Zi) to each link, as follows:
• establish a right-handed orthonormal coordinate frame O0 at
the supporting base with Z0 lying along joint 1 motion axis.
• the Zi axis is directed along the axis of motion of joint (i + 1),
that is, link (i + 1) rotates about or translates along Zi;
Z3
Z0 Z1
Joint 3
Y0 O3 X3
Y1
Link 1 Link 2 d2
Joint 1
O0 X0 O1 X1 O2 X2
Joint 2
Y2
a0 a1
Link Coordinate Frames
– Locate the origin of the ith coordinate at the intersection
of the Zi & Zi-1 or at the intersection of common normal
between the Zi & Zi-1 axes and the Zi axis.
– the Xi axis lies along the common normal from the Zi-1
axis to the Zi axis X i (Zi 1 Zi ) / Zi 1 Zi , (if Zi-1 is
parallel to Zi, then Xi is specified arbitrarily, subject only
to Xi being perpendicular to Zi); Z3
Z0 Z1
Joint 3
Y0 O3 X3
Y1
d2
Joint 1
O0 X0 O1 X1 O2 X2
Joint 2
Y2
a0 a1
Link Coordinate Frames
– Assign Yi (Zi X i ) / Zi X i to complete the right-
handed coordinate system.
• The hand coordinate frame is specified by the geometry On
of the end-effector. Normally, establish Zn along the
direction of Zn-1 axis and pointing away from the robot;
establish Xn such that it is normal to both Zn-1 and Zn
axes. Assign Yn to complete the right-handed coordinate
system. Z3
Z0 Z1
Joint 3
Y0 O3 X3
Y1
d2
Joint 1
O0 X0 O1 X1 O2 X2
Joint 2
Y2
a0 a1
Link and Joint Parameters
• Joint angle i : the angle of rotation from the Xi-1 axis to
the Xi axis about the Zi-1 axis. It is the joint variable if joint i
is rotary.
• Link twist angle i : the angle of rotation from the Zi-1 axis
to the Zi axis about the Xi axis.
Example I Z3
Z0 Z1
Joint 3
Y0 O3 X3
Y1
d2
Joint 1
O0 X0 O1 X1 O2 X2 D-H Link Parameter Table
Joint 2
Y2 Joint i i ai di i
a0 a1 1 0 a0 0 0
Ti i 1 T ( zi 1 , d i ) R ( zi 1 , i )T ( xi , ai ) R ( xi , i )
C i C i S i S i S i ai C i
Reference S C i C i S i C i ai S i
Coordinate i
0 S i C i di
0 0 0 1
Kinematic Equations
• Forward Kinematics q ( q1 , q2 , qn )
– Given joint variables
– End-effector position & orientation Y ( x, y, z , , , )
n
• Homogeneous matrix T 0
– specifies the location of the ith coordinate frame w.r.t.
the base coordinate system
– chain product of successive coordinate transformation
matrices of Ti i 1
Position
T T T T
0
n 1 2
0 1
n
n 1 vector
1 px
p nx sx ax px
2 y n
3 pz sy ay p y
T y
nz sz az pz
4
5 0 0 0 1
6
Solving forward kinematics
• Yaw-Pitch-Roll representation for orientation
CC CSS SC CSC SS px
SC SSS CC SSC CS p y
T0n
S CS CC pz
0 0 0 1
nx sx ax px sin1 (nz )
n p y az
T0n y
sy ay cos ( 1
)
nz sz az pz cos
nx
0 0 0 1 cos (
1
)
cos
Problem? Solution is inconsistent and ill-conditioned!!
atan2(y,x)
y