Homogeneous vector Homogeneous transformation matrix Review: Homogeneous Transformations.

29
Homogeneous vector Homogeneous transformation matrix Review: Homogeneous Transformations

Transcript of Homogeneous vector Homogeneous transformation matrix Review: Homogeneous Transformations.

Page 1: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Homogeneous vector

Homogeneous transformation matrix

Review: Homogeneous Transformations

Page 2: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Compute the position and orientation of the end effector as a function of the joint variables

Review: Aim of Direct Kinematics

Page 3: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

The direct kinematics function is expressed by the homogeneous transformation matrix

Review: Direct Kinematics

Page 4: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Computation of direct kinematics function is recursive and systematic

Review: Open Chain

Page 5: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Review: Denavit-Hartenberg ConventionReview: Denavit-Hartenberg Convention

Page 6: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Review : D-H ConventionReview : D-H Convention

Page 7: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

1. Fill in the table of D-H parameters for the spherical wrist.

Class Problem: Spherical Wrist

2. write the three D-H transformation matrices (one for each joint) for the spherical wrist

3. Find the overall transformation matrix which relates the final coordinates (x6y6z6) to the “base” coordinates (x3y3z3) for the spherical wrist

Page 8: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Review : D-H ConventionReview : D-H Convention

Page 9: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Joint Space and Operational SpaceJoint Space and Operational Space

Description of end-effector task

position: coordinates (easy)

orientation: (n s a) (difficult)

w.r.t base frame

Function of time

Operational space

Independent variables

Joint space

Prismatic: d

Revolute: theta

Page 10: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Joint Space and Operational SpaceJoint Space and Operational Space

Direct kinematics equation

6,),( mnmRqRxqkx nm

Three-link planar arm (Pp50 2-58)

?)( qk

Page 11: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Generally not easy to express

Joint Space and Operational SpaceJoint Space and Operational Space

Page 12: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Joint Space and Operational SpaceJoint Space and Operational Space

Workspace

reachable workspace

dexterous workspace

Factors determining workspace

Manipulator geometry

Mechanical joint limits

Mathematical description of workspace

Workspace is finite, closed, connected

Page 13: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Workspace ExampleWorkspace Example

Page 14: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Performance Indexes of ManipulatorPerformance Indexes of Manipulator

Accuracy of manipulator

Deviation between the reached position and the

position computed via direct kinematics.

repeatability of manipulator

A measure of the ability to return to a previously

reached position.

Page 15: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Kinematic RedundancyKinematic Redundancy

Definition

A manipulator is termed kinematically redundant

when it has a number of degrees of mobility whic

h is greater than the number of variables that are

necessary to describe a given task.

Page 16: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Kinematic RedundancyKinematic Redundancy

Intrinsic redundancy

m<n

functional redundancy

relative to the task

Why to intentionally utilize redundancy?

Page 17: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Kinematic CalibrationKinematic Calibration

Kinematic calibration techniques are devoted to

finding accurate estimates of D-H parameters fr

om a series of measurements on the manipulato

r’s end-effector location.

Direct measurement of D-H is not allowed.

Page 18: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Inverse Kinematics

Page 19: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Inverse KinematicsInverse Kinematics

we know the desired “world” or “base” coordinates for the end-effector or tool

we need to compute the set of joint coordinates that will give us this desired position (and orientation in the 6-link case).

the inverse kinematics problem is much more difficult than the forward problem!

Page 20: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Inverse KinematicsInverse KinematicsInverse KinematicsInverse Kinematics

there is no general purpose technique that will guarantee a closed-form solution to the inverse problem!

Multiple solutions may exist Infinite solutions may exist, e.g., in the case

of redundancy There might be no admissible solutions

(condition: x in (dexterous) workspace)

Page 21: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Inverse KinematicsInverse KinematicsInverse KinematicsInverse Kinematics

most solution techniques (particularly the one shown below) rely a great deal on geometric or algebraic insight and a few common “tricks” to generate a closed-form solution

Numerical solution techniques may be applied to all problems, but in general do not allow computation of all admissible solutions

Page 22: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Three-link Planar ArmThree-link Planar ArmThree-link Planar ArmThree-link Planar Arm

x is known, compute q

Page 23: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

W can be expressed W can be expressed both as a function of both as a function of end-effector p&o, anend-effector p&o, and as a function of a red as a function of a reduced number of joinduced number of joint variablest variables

Three-link Planar ArmThree-link Planar ArmThree-link Planar ArmThree-link Planar Arm

Page 24: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Two-link planar arm

one-link planar arm

21 ,

3

Class problem

Page 25: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Three-link Planar ArmThree-link Planar ArmThree-link Planar ArmThree-link Planar Arm

Algebraic approach

Page 26: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Three-link Planar ArmThree-link Planar ArmThree-link Planar ArmThree-link Planar Arm

no admissible solution If c2 is out of this range

Elbow up and elbow down

Page 27: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Three-link Planar ArmThree-link Planar ArmThree-link Planar ArmThree-link Planar Arm

Page 28: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Geometric approach

Three-link Planar ArmThree-link Planar ArmThree-link Planar ArmThree-link Planar Arm

?

?

i

=?=?l

l

Feasible condition: a1+a2>l and |a1-a2|<l

Page 29: Homogeneous vector  Homogeneous transformation matrix Review: Homogeneous Transformations.

Class Problem

what are the forward and inverse kinematics equations for the two-link planar robot shown on the right?

2nd Joint: Prismatic

1st Joint: Revolute

X0

Y0

90 deg

Attention: m= ?