Denavit - Hartenberg Algorithm
Denavit - Hartenberg Algorithm
Denavit - Hartenberg Algorithm
KP6513
slide 1
Any two neighbouring frames can be brought into coincidence by a prescribed sequence of at most two rotations and two translations.
KP6513
slide 2
Any two neighbouring frames can be brought into coincidence by a prescribed sequence of at most two rotations and two translations. The D-H algorithm is a systematic matrix method based on Homogeneous Transformation Matrices to describe the position and orientation of each link or the tool tip with respect to its neighbouring link in a static situation.
KP6513
slide 2
KP6513
slide 3
Steps to take when performing the D-H algorithm: 1. Assign coordinate frames to all links and the tool tip.
KP6513
slide 3
Steps to take when performing the D-H algorithm: 1. Assign coordinate frames to all links and the tool tip. 2. Derive 4 4 HTM to describe the position and orientation of each link or tool tip wrt its neighbouring link.
KP6513
slide 3
Steps to take when performing the D-H algorithm: 1. Assign coordinate frames to all links and the tool tip. 2. Derive 4 4 HTM to describe the position and orientation of each link or tool tip wrt its neighbouring link. 3. Use the post-multiplication rule to compute the forward kinematics.
KP6513
slide 3
Steps to take when performing the D-H algorithm: 1. Assign coordinate frames to all links and the tool tip. 2. Derive 4 4 HTM to describe the position and orientation of each link or tool tip wrt its neighbouring link. 3. Use the post-multiplication rule to compute the forward kinematics. 4. From the forward kinematic equation, determine the position and orientation of the end effector (tool tip).
KP6513
slide 3
Arm Parameters
KP6513
slide 4
Arm Parameters
q
KP6513
slide 4
Arm Parameters
q q
Dene the robot base as link 0. Number each link and the end effector consecutively in increasing order.
KP6513
slide 4
Arm Parameters
q q
Dene the robot base as link 0. Number each link and the end effector consecutively in increasing order. Joint 1 connects link 0 to link 1.
KP6513
slide 4
Arm Parameters
q q
Dene the robot base as link 0. Number each link and the end effector consecutively in increasing order. Joint 1 connects link 0 to link 1. Joint i connects link i 1 to link i.
q q
KP6513
slide 4
Arm Parameters
q q
Dene the robot base as link 0. Number each link and the end effector consecutively in increasing order. Joint 1 connects link 0 to link 1. Joint i connects link i 1 to link i. Assign a Cartesian frame xi yi zi to each joint.
q q q
KP6513
slide 4
KP6513
slide 5
KP6513
slide 5
The zi axis is aligned with the axis of the rotary joint i + 1. The xi axis
KP6513
slide 5
The zi axis is aligned with the axis of the rotary joint i + 1. The xi axis
3
KP6513
slide 5
The zi axis is aligned with the axis of the rotary joint i + 1. The xi axis
3 3
is normal to both the zi1 and zi axes. points from the intersection of the zi1 and xi axes
KP6513
slide 5
The zi axis is aligned with the axis of the rotary joint i + 1. The xi axis
3 3
is normal to both the zi1 and zi axes. points from the intersection of the zi1 and xi axes to the intersection of the zi and xi axes.
KP6513
slide 5
The zi axis is aligned with the axis of the rotary joint i + 1. The xi axis
3 3
is normal to both the zi1 and zi axes. points from the intersection of the zi1 and xi axes to the intersection of the zi and xi axes.
KP6513
slide 5
Link Parameters
KP6513
slide 6
Link Parameters
q
ai (the link length) is the common normal between the zi1 and zi axes.
KP6513
slide 6
Link Parameters
q
ai (the link length) is the common normal between the zi1 and zi axes. i (the twist angle) is the rotational angle of the zi1 axis about the xi axis such that the zi1 will be parallel to the xi axis after the rotation.
KP6513
slide 6
Joint Parameters
KP6513
slide 7
Joint Parameters
q
i (the joint angle) is the rotational angle of the xi1 axis about the zi1 axis such that the xi1 axis will be parallel to the xi axis after the rotation.
KP6513
slide 7
Joint Parameters
q
i (the joint angle) is the rotational angle of the xi1 axis about the zi1 axis such that the xi1 axis will be parallel to the xi axis after the rotation. d (the joint distance) is the translational distance from oi1 (the origin of the xi1 yi1 zi1 frame) to bi (the intersection of the xi and zi1 axes).
KP6513
slide 7
Arm Parameter Symbol Revolute Joint Joint angle variable Joint distance d constant Link length a constant Twist angle constant
KP6513
slide 8
HTMs
Ti =
0 0 1 0
0 0 0 1
Tai =
1 0 0 0
0 1 0 0
0 0 1 0
ai 0 0 1
Tdi =
1 0 0 0
0 1 0 0
0 0 1 0
0 0 di 1
Ti =
0 0 0 1
KP6513
slide 9
Ci Ci Si Si Si aCi Si Ci Ci Si Ci aSi 0 Si Ci di 0 0 0 1
KP6513
slide 10