m. zareinejad 1. 2 grounded interfaces very similar to robots need kinematics ––––––...

25
Haptics and Virtual Reality M. Zareinejad Lecture 6: Haptic interface kinematics 1

Upload: neil-roberts

Post on 13-Dec-2015

213 views

Category:

Documents


0 download

TRANSCRIPT

Page 1: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

1

Haptics and Virtual Reality

M. Zareinejad

Lecture 6:

Haptic interface kinematics

Page 2: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

2

Grounded interfaces

Very similar to robotsNeed Kinematics–

Determine endpoint positionCalculate velocitiesCalculate force-torque relationships

Sometimes need DynamicsIf you are weak on these topics, you may wantto check out Introduction to robotics:mechanics and control by Craig (1989).

Page 3: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

3

Kinematics

o Think of a manipulator/

interface as a set of bodies

connected by a chain of joints

o Revolute most common for

haptic interfaces

Page 4: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

4

Orientation of a Body

Page 5: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

5

Homogenous Transforms

Page 6: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

6

Homogenous Transforms

Translation

Rotation

Page 7: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

7

Kinematics

Moving between Joint Space and Cartesian Space

Forward kinematics: based on joint angles, calculateend-effector position

Page 8: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

8

Joint variables

Be careful how you define joint positions

Absolute Relative

Page 9: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

9

Absolute forward kinematics

x = L1cos(1) + L2cos(2)

y = L1sin(1) + L2sin(2)

Page 10: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

10

Relative forward kinematics

x = L1cos(1) + L2cos(1+ 2)

y = L1sin(1) + L2sin(1+ 2)

Page 11: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

11

D-H Parameters

Page 12: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

12

D-H Parameters

Page 13: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

13

Inverse Kinematics

Using the end-effector position, calculate thejoint angles

Not used often in haptics– But useful for calibration

There can be:–

No solution (workspace issue)

1 solution

More than 1 solution

Page 14: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

14

Example

Two possible solutions

Two approaches:–

algebraic method

geometric method

Page 15: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

15

Example

Page 16: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

16

Velocity

Recall that the forward kinematics tells us theend-effector position based on joint positions

How do we calculate velocity?

Use a matrix called the Jacobian

Page 17: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

17

Formulating the Jacobian

Use the chain rule:

Take partial derivatives:

Page 18: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

18

Assemble in a Matrix

Page 19: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

19

Singularities

Most devices will have values offor which the Jacobian is singular

This means that the device has lost one ormore degrees of freedom in Cartesian Space

Two kinds:–

Workspace boundary

Workspace interior

Page 20: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

20

Singularity Math

If the matrix is invertible, then it is non-singular

Can check invertibility of J by taking thedeterminant of J. If it is equal to 0, then it issingular

Can use this method to check which values of θwill cause singularities

Page 21: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

21

Calculating Singularities

Simplify text: sin(1+2)=s12

For what values of 1 and 2 does this equalzero?

Page 22: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

22

Even more useful….

The Jacobian can be used to relate jointtorques to end-effector forces:

Why is this important for haptic displays?

Page 23: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

23

How do you get this equation?

Principle of virtual work– States that changing the

coordinate frame doesnot change the total workof a system

Page 24: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

24

Dynamic

Page 25: M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics –––––– Determine endpoint position Calculate velocities Calculate force-torque

25

Homework #1

SensAble’s Phantoms Quanser Pantograph