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

Transcript of M. Zareinejad 1. 2 Grounded interfaces Very similar to robots Need Kinematics ––––––...

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