Lecture 14: Kinesthetic haptic devices: Higher degrees of freedom

Transcription

1 ME 327: Design and Control of Haptic Systems Autumn 2018 Lecture 14: Kinesthetic haptic devices: Higher degrees of freedom Allison M. Okamura Stanford University (This lecture was not given, but the notes are posted for reference)

2 kinematics (Hapkit reminder)

3 transmission 2 Capstan drive Friction drive

4 x handle Hapkit kinematics r pulley pulley = r sector sector r handle x handle = r handle sector r sector sector r pulley pulley x handle = r handler pulley r sector pulley

5 Hapkit force/torque relationships F handle relationship between force and torque: = Fr r handle pulley r pulley = sector r sector F handle = sector r handle r sector sector r pulley pulley F handle = r sector r handle r pulley pulley

6 kinematics (a more complete introduction)

7 suggested references Introduction to robotics : mechanics and control John J. Craig Robot modeling and control Mark W. Spong, Seth Hutchinson, M. Vidyasagar A mathematical introduction to robotic manipulation Richard M. Murray, Zexiang Li, S. Shankar Sastry Springer handbook of robotics B. Siciliano, Oussama Khatib (eds.) docid=

8 kinematics The study of movement The branch of classical mechanics that describes the motion of objects without consideration of the forces that cause it Why do you need it? Determine endpoint position and/or joint positions Calculate mechanism velocities, accelerations, etc. Calculate force-torque relationships

9 degrees of freedom Number of independent position variables needed to in order to locate all parts of a mechanism DOF of motion DOF of sensing DOF of actuation The DOF of a mechanism does not always correspond to number of joints

10 it will help to prototype! round head paper fasteners officedepot.com

11 joints Think of a manipulator/ interface as a set of bodies connected by a chain of joints Revolute is the most common joint for robots From Craig, p. 69

12 forward kinematics for higher degrees of freedom for mechanical trackers that use joint angle sensors, you need a map between joint space and Cartesian space fwd kinematics: from joint angles, calculate endpoint position

13 joint variables Be careful how you define joint positions Absolute Relative

14 absolute forward kinematics x = L 1 cos(θ 1 ) + L 2 cos(θ 2 ) y = L 1 sin(θ 1 ) + L 2 sin(θ 2 ) (Often done this way for haptic devices)

15 relative forward kinematics x = L 1 cos(θ 1 ) + L 2 cos(θ 1 +θ 2 ) y = L 1 sin(θ 1 ) + L 2 sin(θ 1 + θ 2 ) (Often done this way for robots)

16 Inverse Kinematics Using the end-effector position, calculate the joint angles necessary to achieve that position Not used often for haptics But could be useful for planning/design There can be: No solution (workspace issue) One solution More than one solution

17 example Two possible solutions Two approaches: algebraic method (using transformation matrices) geometric method Your devices should be simple enough that you can just use geometry

18 computing end-effector velocity forward kinematics tells us the endpoint position based on joint positions how do we calculate endpoint velocity from joint velocities? use a matrix called the Jacobian ẋ = J q

19 formulating the Jacobian multidimensional form of the chain rule: 1 q 2 q 2 + ẏ q 1 q 2 2 assemble in matrix form: apple ẋ ẏ @q 2 # apple q1 q 2 ẋ = J q

20 Singularities Many devices will have configurations at which the Jacobian is singular This means that the device has lost one or more degrees of freedom in Cartesian Space Two kinds: Workspace boundary Workspace interior

21 Singularity Math If the matrix is invertible, then it is non-singular. θ = J 1 x Can check invertibility of J by taking the determinant of J. If the determinant is equal to 0, then J is singular. Can use this method to check which values of θ will cause singularities.

22 Calculating Singularities Simplify text: sin(θ 1 +θ 2 )=s 12 det( J( θ) ) = L 1s L s L s L c + L c L c = ( L 1 s 1 L 2 s 12 )L 2 c 12 + (L 1 c 1 + L 2 c 12 )L 2 s 12 For what values of θ 1 and θ 2 does this equal zero?

23 compute the necessary joint torques the Jacobian can also be used to relate joint torques to end-effector forces: = J T f this is a key equation for multi-degree-offreedom haptic devices

24 how do you get this equation? the Principle of virtual work f x = q f T x = T q states that changing the coordinate frame does not change the total work of a system f T J q = T f T J = T J T f = q

25 force generation signals desired force (in computer) counts D/A volts amplifiers voltage or current actuator force/torque transmission & kinematics endpoint force/torque

26 Phantom Omni kinematics

27 Phantom Omni End-Effector Base Rear Front

28 phantom omni link lengths

29 phantom omni End-Effector End-Effector End-Effector singular configurations

30 phantom omni If 3 is fixed, we can regard this as a two-link manipulator. When 3 = 0, on the y z plane, apple y z = apple l1 sin 1 + l 2 sin 2 l 1 cos 1 + l 2 cos 2 Now, let us consider 3. Note that 3 a ects x and z position, but not y position. So, we first calculate a link length, L, on the z x plane: L = l 1 cos 1 + l 2 cos 2 (1) Then, rotating the link length L around the y-axis gives you the forward kinematics of an Omni: x L sin 3 (l 1 cos 1 + l 2 cos 2 )sin 3 4 y 5 = 4 l 1 sin 1 + l 2 sin 2 5 = 4 l 1 sin 1 + l 2 sin 2 5 z L cos 3 (l 1 cos 1 + l 2 cos 2 ) cos 3

31 phantom omni By definition, Jacobian matrix for the Omni is 2 3 J = = l 1 sin 1 sin 3 l 2 sin 2 sin 3 (l 1 cos 1 + l 2 cos 2 ) cos 3 l 1 cos 1 l 2 cos 2 0 l 1 sin 1 cos 3 l 2 sin 2 cos 3 (l 1 cos 1 + l 2 cos 2 )sin 3 3 5

32 6 4 2 phantom 7 omni 5 4 Assume the device currently has joint angles θ = [ ] T, which is near the center of its workspace. If the joint velocities are θ = [ ] degrees per second, what is the vector of Cartesian endpoint velocities? 3 5 Computing the cartesian endpoint velocities is straightword using the Jacobian and the joint velocities. The joint velocities must first be converted into rad/s. 2 4 ẋ ẏ ż 3 5 = J = J = [m/s]

33 phantom omni Suppose that you want the robot end-effector to push on tissue with a Cartesian force vector of F = [ 4 1 3] T N. Your device is at the same position as stated above. What vector of joint torques would be needed to create this force at the end-effector? You can calculate joint torques from Jacobian matrix and Cartesian force: = J 2 T F 0.19 = [N-m] Note that this assumes that all the energy generated from the motors would equal the work done by the end e ector, that is, there is no energy loss.

34 pantograph mechanism

35 pantograph Definition 1: a mechanical linkage connected in a manner based on parallelograms so that the movement of one pen, in tracing an image, produces identical movements in a second pen. Definition 2: a kind of structure that can compress or extend like an accordion

36 pantograph haptic device Xiyang Yeh, ME

37 pantograph haptic device Sam Schorr and Jared Muirhead, ME

38 pantograph haptic device a b c d e f N f T Campion and Hayward, IROS

39 example Find the forward kinematics Find the Jacobian

40 rendering

41

42 a commercial 3-DOF device 2014 slides from Francois Conti about Force Dimension and the Novint Falcon

43 Designing Commercial Haptic Devices ME /09/2014 François Conti Artificial Intelligence Laboratory Department of Computer Science Stanford University

44 Commercial Haptic Devices A 10 Year Journey François Conti - ME Stanford University - May 2014

45 Developing a Product Industrial Design omega.3 Force Dimension François Conti - ME Stanford University - May 2014

46 3D Consumer Haptic Interfaces Design Challenges omega.3 $ Falcon $200 François Conti - ME Stanford University - May 2014

47 3D Consumer Haptic Interfaces Design Challenges Maxon Motor $150 Johnson Motor $1.50 François Conti - ME Stanford University - May 2014

48 Position Sensors Optical Encoders quadrature signal CH A CH B position optical encoder Resolution 1000 increments per revolution. Low signal noise Signal remains digital. No analog conversion. Contact Frictionless. No contact between optical disc and sensor. Cost US$ for an encoder and counter. Phantom Sensable Technologies François Conti - ME Stanford University - May 2014

49 Position Sensors Optical Encoders François Conti - ME Stanford University - May 2014

50 Position Sensors Optical Encoders François Conti - ME Stanford University - May 2014

51 François Conti - ME Stanford University - May 2014 Mechanical Design Articulated Systems

52 Communication Interface Information Transfer position sensing receiving position data actuation information transfer force output computing forces François Conti - ME Stanford University - May 2014

53 Computation Position and Force forward kinematics q 2 y q 1 Joint space position x Cartesian position t = J T F t 2 y F t 1 Motors torques x Force computation François Conti - ME Stanford University - May 2014

54 Actuation Stage Current Amplifiers force DAC current amplifier digital to analog signal conversion torque / force commands François Conti - ME Stanford University - May 2014

55 Product Creation Designing Prototypes Prototype Force Dimension, Lunar Design François Conti - ME Stanford University - May 2014

56 Product Creation Designing Prototypes Prototype Force Dimension François Conti - ME Stanford University - May 2014

57 Product Creation Industrial Design Falcon Novint Technologies, Force Dimension François Conti - ME Stanford University - May 2014

58 Product Creation Industrial Design François Conti - ME Stanford University - May 2014

59 Product Creation Industrial Design François Conti - ME Stanford University - May 2014

60 Product Creation Industrial Design François Conti - ME Stanford University - May 2014

61 Product Creation First Production François Conti - ME Stanford University - May 2014

62 Product Creation Launching the Product François Conti - ME Stanford University - May 2014

63 Patents Protecting Ideas François Conti - ME Stanford University - May 2014

64 Medical Applications High-End Interfaces François Conti - ME Stanford University - May 2014

65 Medical Applications Building Partnerships Sensei Hansen Medical, Force Dimension François Conti - ME Stanford University - May 2014

66 Quality Control Certification and Validation François Conti - ME Stanford University - May 2014

67 Haptics The Sense of Touch François Conti - ME Stanford University - May 2014

68 Haptic Devices Market and Applications Cybergrasp Virtual Technologies Phantom MIT / Sensable Technologies idrive Immersion Corporation Haptic Workstation Immersion François Conti - ME Stanford University - May 2014

69 Le Syntaxeur EPFL Ecole Polytechnique Fédérale de Lausanne Le Syntaxeur EPFL, Switzerland François Conti - ME Stanford University - May 2014

70 Creating a Company Designing and Manufacturing Haptic Devices Force Dimension Switzerland François Conti - ME Stanford University - May 2014