790 likes | 1.29k Views
More details and examples on robot arms and kinematics. Denavit-Hartenberg Notation. INTRODUCTION. Forward Kinematics : to determine where the robot ’ s hand is? (If all joint variables are known) Inverse Kinematics: to calculate what each joint variable is?
E N D
More details and examples on robot arms and kinematics Denavit-Hartenberg Notation
INTRODUCTION Forward Kinematics: to determine where the robot’s hand is? (If all joint variables are known) Inverse Kinematics: to calculate what each joint variable is? (If we desire that the hand be located at a particular point)
Where is my hand? Direct Kinematics with no matrices Direct Kinematics: HERE!
Direct Kinematics • Position of tip in (x,y) coordinates
Direct Kinematics Algorithm Often sufficient for 2D 1) Draw sketch 2) Number links. Base=0, Last link = n 3) Identify and number robot joints 4) Draw axis Zifor joint i 5) Determine joint length ai-1between Zi-1and Zi 6) Draw axis Xi-1 7) Determine joint twist i-1 measured around Xi-1 8) Determine the joint offset di 9) Determine joint angle i around Zi 10+11) Write link transformation and concatenate
Kinematic Problems for Manipulation • Reliably position the tip - go from one position to another position • Don’t hit anything, avoid obstacles • Make smooth motions • at reasonable speeds and • at reasonable accelerations • Adjust to changing conditions - • i.e. when something is picked up respond to the change in weight
Robot Kinematics: ROBOTS AS MECHANISM Multiple type robot have multiple DOF. (3 Dimensional, open loop, chain mechanisms) Fig. 2.1 A one-degree-of-freedom closed-loop four-bar mechanism Fig. 2.2 (a) Closed-loop versus(b) open-loop mechanism
Representation of a Point in Space Chapter 2Robot Kinematics: Position Analysis A point P in space : 3 coordinates relative to a reference frame Fig. 2.3 Representation of a point in space
Representation of a Vector in Space Chapter 2Robot Kinematics: Position Analysis A Vector P in space : 3 coordinates of its tail and of its head Fig. 2.4 Representation of a vector in space
Representation of a Frame at the Origin of a Fixed-Reference Frame Chapter 2Robot Kinematics: Position Analysis Each Unit Vector is mutually perpendicular. : normal, orientation, approach vector Fig. 2.5 Representation of a frame at the origin of the reference frame
Representation of a Frame in a Fixed Reference Frame Chapter 2Robot Kinematics: Position Analysis Each Unit Vector is mutually perpendicular. : normal, orientation, approach vector The same as last slide Fig. 2.6 Representation of a frame in a frame
Representation of a Rigid Body Chapter 2Robot Kinematics: Position Analysis An object can be represented in space by attaching a frame to it and representing the frame in space. Fig. 2.8 Representation of an object in space
HOMOGENEOUS TRANSFORMATION MATRICES Chapter 2Robot Kinematics: Position Analysis • A transformation matrices must be in square form. • It is much easier to calculate the inverse of square matrices. • To multiply two matrices, their dimensions must match.
Representation of Transformations of rigid objects in 3D space
Representation of a Pure Translation Chapter 2Robot Kinematics: Position Analysis • A transformation is defined as making a movement in space. • A pure translation. • A pure rotation about an axis. • A combination of translation or rotations. Same value a identity Fig. 2.9 Representation of an pure translation in space
Representation of a Pure Rotation about an Axis Chapter 2Robot Kinematics: Position Analysis x,y,z n, o, a Assumption : The frame is at the origin of the reference frame and parallel to it. Projections as seen from x axis Fig. 2.10 Coordinates of a point in a rotating frame before and after rotation around axis x. Fig. 2.11 Coordinates of a point relative to the reference frame and rotating frame as viewed from the x-axis.
Representation of Combined Transformations A number of successive translations and rotations…. T1 ai Fig. 2.13 Effects of three successive transformations oi ni T2 T3 x,y,z n, o, a Order is important
x,y,z n, o, a translation Order of Transformations is important Fig. 2.14Changing the order of transformations will change the final result
Transformations Relative to the Rotating Frame Chapter 2Robot Kinematics: Position Analysis Example 2.8 translation rotation Fig. 2.15 Transformations relative to the current frames.
MATRICES FORFORWARD AND INVERSE KINEMATICS OF ROBOTS • For position • For orientation
FORWARD AND INVERSE KINEMATICS OF ROBOTS Chapter 2Robot Kinematics: Position Analysis • Forward Kinematics Analysis: • • Calculating the position and orientation of the hand of the robot. • If all robot joint variables are known, one can calculate where the robot is • at any instant. • . Fig. 2.17 The hand frame of the robot relative to the reference frame.
Forward and Inverse KinematicsEquations for Position Chapter 2Robot Kinematics: Position Analysis Forward Kinematics and Inverse Kinematics equation for position analysis : (a) Cartesian (gantry, rectangular) coordinates. (b) Cylindrical coordinates. (c) Spherical coordinates. (d) Articulated (anthropomorphic, or all-revolute) coordinates.
Forward and Inverse KinematicsEquations for Position (a) Cartesian (Gantry, Rectangular) Coordinates Chapter 2Robot Kinematics: Position Analysis IBM 7565 robot • All actuator is linear. • A gantry robot is a Cartesian robot. Fig. 2.18 Cartesian Coordinates.
Forward and Inverse KinematicsEquations for Position: Cylindrical Coordinates Chapter 2Robot Kinematics: Position Analysis 2 Linear translations and 1 rotation • translation of r along the x-axis • rotation of about the z-axis • translation of l along the z-axis cosine sine Fig. 2.19 Cylindrical Coordinates.
Forward and Inverse KinematicsEquations for Position (c) Spherical Coordinates Chapter 2Robot Kinematics: Position Analysis 2 Linear translations and 1 rotation • translation of r along the z-axis • rotation of about the y-axis • rotation of along the z-axis Fig. 2.20 Spherical Coordinates.
Forward and Inverse KinematicsEquations for Position (d) Articulated Coordinates Chapter 2Robot Kinematics: Position Analysis 3 rotations -> Denavit-Hartenberg representation Fig. 2.21 Articulated Coordinates.
Forward and Inverse KinematicsEquations for Orientation Chapter 2Robot Kinematics: Position Analysis Roll, Pitch, Yaw (RPY) angles Euler angles Articulated joints
Forward and Inverse KinematicsEquations for Orientation (a) Roll, Pitch, Yaw(RPY) Angles Roll: Rotation of about -axis (z-axis of the moving frame) Pitch: Rotation of about -axis (y-axis of the moving frame) Yaw: Rotation of about -axis (x-axis of the moving frame) Chapter 2Robot Kinematics: Position Analysis Fig. 2.22 RPY rotations about the current axes.
Forward and Inverse KinematicsEquations for Orientation (b) Euler Angles Rotation of about -axis (z-axis of the moving frame) followed by Rotation of about -axis (y-axis of the moving frame) followed by Rotation of about -axis (z-axis of the moving frame). Chapter 2Robot Kinematics: Position Analysis Fig. 2.24 Euler rotations about the current axes.
Forward and Inverse KinematicsEquations for Orientation Chapter 2Robot Kinematics: Position Analysis Roll, Pitch, Yaw(RPY) Angles • Assumption : Robot is made of a Cartesian and an RPY set of joints. • Assumption : Robot is made of a Spherical Coordinate and an Euler angle. Another Combination can be possible…… Denavit-Hartenberg Representation
INVERSE OF TRANSFORMATION MATRICES • Steps of calculation of an Inverse matrix: • Calculate the determinant of the matrix. • Transpose the matrix. • Replace each element of the transposed matrix by its own minor (adjoint matrix). • Divide the converted matrix by the determinant. Fig. 2.16 The Universe, robot, hand, part, and end effecter frames.
We often need to calculate INVERSE MATRICES It is good to reduce the number of such operations We need to do these calculations fast
Homogeneous Coordinates • Homogeneous coordinates: embed 3D vectors into 4D by adding a “1” • More generally, the transformation matrix T has the form: a11 a12 a13 b1 a21 a22 a23 b2 a31 a32 a33 b3 c1 c2 c3sf It is presented in more detail on the WWW!
For various types of robots we have different maneuvering spaces
For various types of robots we calculate different forward and inverse transformations
For various types of robots we solve different forward and inverse kinematic problems
DENAVIT-HARTENBERG REPRESENTATION OF FORWARD KINEMATIC EQUATIONS OF ROBOT Fig. 2.25 A D-H representation of a general-purpose joint-link combination • Denavit-Hartenberg Representation : @ Simple way of modeling robot links and joints for any robot configuration, regardless of its sequence or complexity. @ Transformations in any coordinates is possible. @ Any possible combinations of joints and links and all-revolute articulated robots can be represented.
DENAVIT-HARTENBERG REPRESENTATION Symbol Terminologies : Chapter 2Robot Kinematics: Position Analysis ⊙: A rotation angle between two links, about the z-axis (revolute). ⊙d : The distance (offset) on the z-axis, between links (prismatic). ⊙a : The length of each common normal (Joint offset). ⊙ : The “twist” angle between two successive z-axes (Joint twist) (revolute) Only anddare joint variables.
associated with Zi always Links are in 3D, any shape
Only translation Only offset Only rotation Only rotation Axis alignment Only offset