1 of 153

U21BMP37�ROBOTICS IN MEDICINE

Dr. N. Rajasingam

2 of 153

UNIT - I - INTRODUCTION

Automation and Robots - Classification - Specification - Notations - Direct kinematics - Dot and cross products - Coordinate frames - Rotations - Homogeneous coordinates - Link coordinates - Arm equation - Four-axis robot.

CO1: Infer with the basics of robotic systems (Understand)

2

3 of 153

Automation

  • The creation and application of technologies to produce and deliver goods and services with minimal human intervention.
  • Over the ensuing decades, specialized machines have been designed and developed for high-volume production of mechanical and electrical parts.

3

4 of 153

Hard automation

  • When each yearly production cycle ends and new models of the parts are to be introduced, the specialized machines have to be shut down and the hardware retooled for the next generation of models. Since periodic modification of the production hardware is required.
  • Here the machines and processes are often very efficient, but they have limited flexibility.

4

5 of 153

Soft automation

  • Auto industry and other industries have introduced more flexible forms of automation in the manufacturing cycle.
  • Programmable mechanical manipulators are now being used to perform such tasks as spot welding, spray painting, material handling, and component assembly.

5

6 of 153

  • Since computer-controlled mechanical manipulators can be easily converted through software to do a variety of tasks.
  • The cost effectiveness of manual labor, hard automation, and soft automation can be qualitatively compared as a function of the production volume.

6

7 of 153

Relative cost-effectiveness of automation

7

8 of 153

Robot

  • A robot is a software-controllable mechanical device that uses sensors to guide one or more end-effectors through programmed motions in a workspace in order to manipulate physical objects.

8

9 of 153

Robot Classification

  • In order to refine the general notion of a robotic manipulator, it is helpful to classify manipulators according to various criteria such as drive technologies, work envelope geometries and motion control methods.

9

10 of 153

Drive Technologies

  • One of the most fundamental classification schemes is based upon the source of power used to drive the joints of the robot.
  • The two most popular drive technologies are electric and hydraulic.
  • Most robotic manipulators today use electric drives in the form of either DC servomotors or DC stepper motors.

10

11 of 153

Drive Technologies

  • However, when high-speed manipulation of substantial loads is required, such as in molten steel handling or auto body part handling, hydraulic-drive robots are preferred.
  • One serious drawback of hydraulic-drive robots lies in their lack of cleanliness, a characteristic that is important for many assembly applications.

11

12 of 153

Drive Technologies

  • Both electric-drive robots and hydraulic-drive robots often use pneumatic tools or end-effectors, particularly when the only gripping action required is a simple open-close type of operation. An important characteristic of air-activated tools is that they exhibit built-in compliance in grasping objects, since air is a compressible fluid.

12

13 of 153

Work-Envelope Geometries

  • The end-effector, or tool of a robotic manipulator is typically mounted on a flange or plate secured to the wrist of the robot.
  • The gross work envelope of a robot is defined as the locus of points in three-dimensional space that can be reached by the wrist.

13

14 of 153

Work-Envelope Geometries

  • Major axes: used to determine the position of the wrist.
  • Minor axes: used to establish the orientation of the tool.
  • Geometry of the work envelope is determined by the sequence of joints used for the first three axes (major).

14

15 of 153

Work-Envelope Geometries

  • Revolute joints (R): exhibit rotary motion about an axis. They are the most common type of joint.

  • Prismatic joint (P): exhibits sliding or linear motion along an axis. The particular combination of revolute and prism.

15

16 of 153

Work-Envelope based on Major axes

16

17 of 153

Work-Envelope Geometries

17

18 of 153

Cartesian-coordinate Robot

  • The three major axes are all prismatic; the resulting notation for this configuration is PPP.
  • The three sliding joints correspond to moving the wrist
          • up and down
          • in and out
          • back and forth

18

19 of 153

Cartesian-coordinate Robot

19

20 of 153

Cartesian-coordinate Robot

20

21 of 153

Cartesian-coordinate robot

  • It is evident that the work envelope or work volume that this configuration generates is a rectangular box where it also called as rectangular-coordinate robot.
  • When a Cartesian-coordinate robot is mounted from above in a rectangular frame, it is referred to as a gantry robot.

21

22 of 153

Gantry Robot

22

23 of 153

Cylindrical-coordinate Robot

  • The first joint of a Cartesian-coordinate robot is replaced with a revolute joint (to form the configuration RPP).
  • The revolute joint swings the arm back and forth about a vertical base axis.
  • The prismatic joints then move the wrist up and down along the vertical axis and in and out along a radial axis.

23

24 of 153

Cylindrical-coordinate Robot

24

25 of 153

Cylindrical-coordinate Robot

  • Since there will be some minimum radial position, the work envelope generated by this joint configuration is the volume between two vertical concentric cylinders.

25

26 of 153

Spherical-coordinate Robot

  • The second joint of a cylindrical-coordinate robot is replaced with a revolute joint (so that the configuration is then RRP).
  • Here the first revolute joint swings the arm back and forth about a vertical base axis, while the second revolute joint pitches the arm up and down about a horizontal shoulder axis.

26

27 of 153

Spherical-coordinate Robot

27

28 of 153

Spherical-coordinate Robot

  • The prismatic joint moves the wrist radially in and out.
  • The work envelope generated in this case is the volume between two concentric spheres.
  • The spheres are typically truncated from above, below, and behind by limits on the ranges of travel of the joints.

28

29 of 153

Selective Compliance Assembly Robot Arm

  • It has two revolute joints and one prismatic joint (in the configuration RRP) to position the wrist.
  • However, for a SCARA robot the axes of all three joints are vertical.
  • The two revolute joints control motion in a horizontal plane.
  • The first revolute joint swings the arm back and forth about a base axis that can also be thought of as a vertical shoulder axis.

29

30 of 153

SCARA Robot

30

31 of 153

Selective Compliance Assembly Robot Arm

  • The second revolute joint swings the forearm back and forth about a vertical elbow axis.
  • The vertical component of the motion is provided by the third joint, a prismatic joint which slides the wrist up and down.
  • The shape of a horizontal cross section of the work envelope can be quite complex, depending upon the limits on the ranges of travel for the first two axes.

31

32 of 153

Articulated-coordinate Robot

  • When the last remaining prismatic joint is replaced by a revolute joint (to yield the configuration RRR).
  • It is the dual of a Cartesian robot in the sense that all three of the major axes are revolute rather than prismatic.
  • It is the most anthropomorphic configuration; that is, it most closely resembles the anatomy of the human arm.

32

33 of 153

Articulated-coordinate Robot

33

34 of 153

Articulated-coordinate Robot

  • Articulated robots are also called revolute robots.
  • The first revolute joint swings the robot back and forth about a vertical base axis.
  • The second joint pitches the arm up and down about a horizontal shoulder axis.

34

35 of 153

Articulated-coordinate Robot

  • The third joint pitches the forearm up and down about a horizontal elbow axis.
  • These motions create a complex work envelope, with a side-view cross section typically being crescent-shaped.

35

36 of 153

Articulated-coordinate Robot

36

37 of 153

Motion Control Methods

  • Another fundamental classification criterion is the method used to control the movement of the end-effector or tool.
  • The two basic types of movement are
        • point-to-point motion
        • continuous-path or controlled-path motion

37

38 of 153

Point-to-Point Motion

  • The tool moves to a sequence of discrete points in the workspace.
  • The path between the points is not explicitly controlled by the user.
  • It is useful for operations which are discrete in nature.
  • Ex: spot welding, pick and place, loading and unloading.

38

39 of 153

Continuous-Path Motion

  • The end-effector must follow a prescribed path in three- dimensional space, and the speed of motion along the path may vary.
  • Presents a more challenging control problem.
  • Ex: paint spraying, arc welding and the application of glue or sealant.

39

40 of 153

Robot Specifications

  • There are a number of additional characteristics that allow the user to further specify robotic manipulators.

40

41 of 153

Number of Axes

  • Each robotic manipulator has a number of axes about which its links rotate or along which its links translate.
  • Usually, the first three axes, or major axes, are used to establish the position of the wrist, while the remaining axes are used to establish the orientation of the tool or gripper.

41

42 of 153

Number of Axes

  • Practical industrial robots typically have from four to six axes.

42

43 of 153

Number of Axes

  • Since robotic manipulation is done in three-dimensional space, a six-axis robot is a general manipulator in the sense that it can move its tool or hand to both an arbitrary position and an arbitrary orientation within its workspace.
  • The mechanism for opening and closing the fingers or otherwise activating the tool is not regarded as an independent axis, because it does not contribute to either the position / orientation.

43

44 of 153

Number of Axes

  • The redundant axes can be useful for manipulators with more than six axes, as reaching around obstacles in the workspace or avoiding undesirable geometrical configurations of the manipulator.

44

45 of 153

Load-carrying capacity

  • Load-carrying capacity varies greatly between robots.
  • For example, the Mini-mover 5 Microbot, an educational table-top robot, has a load-carrying capacity of 2.2 kg.
  • At the other end of the spectrum, the GCA-XR6 Extended Reach industrial robot has a load-carrying capacity of 4928 kg.

45

46 of 153

Maximum tool-tip Speed

  • The maximum tool-tip speed can also vary substantially between manipulators.
  • The Westinghouse Series 4000 robot has a tool-tip speed of 92 mm/sec, while the Adept One SCARA robot has a tool-tip speed of 9000 mm/sec.

46

47 of 153

Cycle Time

  • The time required to perform a periodic motion.
  • The Adept One SCARA robot carrying a 2.2-kg payload along a 700-mm path that consists of six straight-line segments has a cycle time of 0.9 sec.
  • Thus the average speed over a cycle is 778 mm/sec, considerably less than the 9000 mm/sec maximum tool-tip speed.

47

48 of 153

Reach and Stroke

  • The reach and stroke of a robotic manipulator are rough measures of the size of the work envelope.
  • Horizontal reach: the maximum radial distance the wrist mounting flange can be positioned from the vertical axis about which the robot rotates.
  • Horizontal stroke: the total radial distance the wrist can travel.

48

49 of 153

Reach and Stroke

  • Thus the horizontal reach minus the horizontal stroke represents the minimum radial distance the wrist can be positioned from the base axis.
  • Since this distance is non-negative

Stroke<= Reach

49

50 of 153

Reach and Stroke

  • Vertical reach: the maximum elevation above the work surface that the wrist mounting flange can reach.
  • Vertical stroke: the total vertical distance that the wrist can travel.
  • Since this distance is non-negative

Stroke<= Reach

50

51 of 153

Reach and Stroke

51

52 of 153

Repeatability

  • A measure of the ability of the robot to position the tool tip in the same place repeatedly.
  • On account of such things as backlash in the gears and flexibility in the links, there will always be some repeatability error, perhaps on the order of a small fraction of a millimeter for a well-designed manipulator.

52

53 of 153

Precision

  • A measure of the spatial resolution with which the tool can be positioned within the work envelope.

53

54 of 153

Accuracy

  • A measure of the ability of the robot to place the tool tip at an arbitrarily prescribed location in the work envelope.

54

55 of 153

Operating Environments

  • The operating environments within which robots function depend on the nature of the tasks performed.
  • Often robots are used to perform jobs in harsh, dangerous, or unhealthy environments.
  • Ex: transport of radioactive materials, spray painting, welding, and the loading and unloading of furnaces.

55

56 of 153

Operating Environments

  • The robot must be specifically designed to operate in extreme temperatures and contaminated air.
  • In the case of paint spraying, a robotic arm might be clothed in a shroud in order to minimize the contamination of its joints by the airborne paint particles.

56

57 of 153

Operating Environments

  • Clean room robots are used in the semiconductor manufacturing industry for such tasks as the handling of silicon wafers and photomasks.
  • Here the robot is operating in an environment in which parameters such as temperature, humidity, and airflow are carefully controlled.

57

58 of 153

Tool Orientation

  • Independent minor axes determine the kinds of orientation that the tool or hand can assume.
  • Tool orientation convention : yaw-pitch-roll (YPR) system.
  • Yaw, pitch, and roll angles have long been used in the aeronautics industry to specify the orientation of aircraft.

58

59 of 153

Tool Orientation

59

60 of 153

Tool orientation

  • Mobile tool coordinate frame M= (m1, m2, m3) is attached to the tool and moves with the tool
  • m3 : aligned with the principal axis of the tool and points away from the wrist.
  • m2 : parallel to the line followed by the fingertips of the tool as it opens and closes.

60

61 of 153

Tool orientation

  • m1 : completes the right-handed tool coordinate frame.
  • By convention, the yaw, pitch, and roll motions are performed in a specific order about a set of fixed axes.
  • Initially, the mobile tool frame M starts out coincident with a fixed wrist coordinate frame F = {f1, f2, f3} attached at the end of the forearm.

61

62 of 153

Tool orientation

  • First the yaw motion is performed by rotating the tool about wrist axis f1.
  • Next, the pitch motion is performed by rotating the tool about wrist axis f2.
  • Finally, the roll motion is performed by rotating the tool about wrist axis f3.

62

63 of 153

Spherical Wrist

  • A robot has a spherical wrist if and only if the axes used to orient the tool intersect at a point.

63

64 of 153

NOTATION

  • Scalars
  • Vectors
  • Matrices
  • Sets

64

65 of 153

NOTATION

65

66 of 153

NOTATION

66

67 of 153

Column vector

  • Represented by arranging its components in an n*1 array and enclosing them in square brackets.

67

68 of 153

Column vector

  • Superscript T : reserved to denote the transpose of a vector
  • The transpose is obtained by interchanging the rows with the columns.
  • Thus the transpose of an n*1 column vector is a 1*n row vector, and conversely.

68

69 of 153

Column vector

  • : denotes the square of the first component of the vector x
  • : denotes the first component of the second member of a set of vectors

69

70 of 153

Sets

  • Curly brackets or braces are used to enclose members of a set.

70

71 of 153

Matrices

  • Just as a vector can be represented as a one-dimensional array of scalar components, a matrix can be represented by a two-dimensional array of scalar components.

71

72 of 153

Matrices

  • It is also useful to represent a matrix in terms of its columns.
  • Lowercase letter with a superscript index : denote a column of a matrix. [aj : denotes the jth column of the matrix A]
  • The entire m*n matrix A can be written in terms of its n columns

72

73 of 153

Dot and Cross Products

  • The dot product of two vectors x and y in Rn is denoted x • y and is defined:

  • The dot product is also called the Euclidean inner product in Rn.
  • The matrix transpose operation can be used to express the dot product more compactly as

73

74 of 153

Dot Product

  • x and y be arbitrary vectors in Rn
  • θ be the angle from x to y.

74

75 of 153

Cross Product

  • u and v be arbitrary vectors in Rn
  • θ be the angle from u to v.

75

76 of 153

Norm

  • The norm of a vector x in Rn is denoted as ||x|| and is defined

76

77 of 153

Orthogonality

  • Two vectors x and y in Rn are orthogonal if and only if

77

78 of 153

Completeness

  • An orthogonal set of vectors (x1, x2 ..., xn} in Rn is complete if and only if

78

79 of 153

Properties

  • Nonnegative
  • Zero only for the zero vector
  • Commutative function
  • Linear function

79

80 of 153

Cross Product

80

81 of 153

Dot and Cross Product

81

82 of 153

Direct Kinematics

  • A robotic manipulator can be modeled as a chain of rigid bodies called links.
  • The links are interconnected to one another by joints.
  • One end of the chain of links is fixed to a base, while the other end is free to move.
  • The mobile end has a flange or face plate, with a tool or end-effector, attached to it.

82

83 of 153

Direct Kinematics

83

84 of 153

Direct Kinematics

  • There are typically two types of joints which interconnect the links:
    • revolute joints: rotational motion about an axis
    • prismatic joints: sliding motion along an axis
  • The objective is to control both the position and the orientation of the tool in three-dimensional space.

84

85 of 153

Direct Kinematics Problem

  • The tool or end-effector, can then be programmed to follow a planned trajectory so as to manipulate objects in the workspace.
  • In order to program the tool motion, the relationship between the joint variables and the position and the orientation of the tool has to be formulated.

85

86 of 153

Coordinates

86

87 of 153

Coordinate Frames

  • Orthonormal coordinate frames attached to the fixed and the mobile links:

  • Coordinates of p:

87

88 of 153

Direct Coordinates Transformation

88

Where A

89 of 153

Example: Coordinate Transformation

  • For the two coordinate frames in Figure, suppose the coordinates of the point p with respect to the mobile coordinate frame are measured and found to be [p]M = [0.6, 0.5, 1.4]T. What are the coordinates of p with respect to the fixed coordinate frame F with the body in the position shown?

89

90 of 153

Solution:

90

91 of 153

Inverse Coordinates Transformation

91

92 of 153

Coordinate Frames

92

93 of 153

Fundamental Rotations

93

94 of 153

94

95 of 153

95

96 of 153

Example: Fundamental Rotation

  • Refer to Figure, where the mobile coordinate frame M is rotated about the f1 axis of the fixed coordinate frame F. Let joint angle = π/3 radians be the amount of rotation. Suppose p is a point whose coordinates in the mobile M frame are [p]M = [2, 0, 3]T. What are the coordinates of p in the fixed coordinate frame F?

96

97 of 153

Solution:

97

98 of 153

Example: Fundamental Rotation

  • Refer to Figure, suppose q is a point whose coordinates in the fixed coordinate frame F are given by [qJF = [3, 4, 0]T. What are the coordinates of q with respect to the mobile coordinate frame M?

98

99 of 153

Solution:

99

100 of 153

Composite Rotations

100

101 of 153

Composite Rotations

101

102 of 153

Yaw-Pitch-Roll matrix [YPR(⍬)]

102

103 of 153

Example: Composite Rotation

  • Suppose we rotate the tool in Figure about the fixed axes starting with a yaw of π/2 , followed by a pitch of - π/2 and, finally, a roll of π/2. What is the resulting composite rotation matrix?

103

104 of 153

Solution:

104

105 of 153

Example: Composite Rotation

  • Suppose the point p at the tool tip has mobile coordinates [p]M = [0, 0, 0.6]T. Find [p]F following the yaw-pitch-roll transformation.

105

106 of 153

Solution:

106

107 of 153

Homogeneous Transformation Matrix

107

108 of 153

Rotation Matrix

  • The 3 X 3 submatrix R in the upper left corner of T.
  • It represents the orientation of the mobile coordinate frame relative to the fixed reference frame.

108

109 of 153

Translation Vector

  • The 3 × 1 column vector p in the upper right corner of T is a translation vector.
  • It represents the position of the origin of the mobile coordinate frame relative to the fixed reference frame.

109

110 of 153

  • The scalar 0 in the lower right corner of T is a nonzero scale factor which is typically set to unity.
  • The 1 × 3 row vector η in the lower left corner of T is a perspective vector.

110

111 of 153

Fundamental Homogeneous Rotation Matrix

111

112 of 153

Example: Homogeneous Rotation

  • Suppose that [q]M = [0, 0, 10, 1]T represents the homogeneous coordinates of a point located 10 units along the third vector of a mobile coordinate frame M. Suppose that initially M is coincident with a fixed coordinate frame F. If we rotate the mobile M frame by π/4 radians about the first unit vector of F, then find the physical coordinates of the point q in the fixed coordinate frame F.

112

113 of 153

Solution:

113

114 of 153

Solution:

114

115 of 153

Fundamental Homogeneous Translation Matrix

115

116 of 153

Example: Homogeneous Translation

  • Suppose that [q]M = [0, 0, 10, 1]T represents the homogeneous coordinates of a point located 10 units along the third vector of a mobile coordinate frame M. Suppose we translate the mobile M coordinate frame relative to the fixed F coordinate frame by 5 units along the f1 axis and -3 units along the f2 axis. Find the physical coordinates of the point q in the fixed coordinate frame F.

116

117 of 153

Solution:

117

118 of 153

Example: Composite Transformation

  • Let F = {f1, f2 ,f3) and M ={m1, m2, m3) be two initially coincident fixed and mobile orthonormal coordinate frames, respectively. Suppose we translate M along f2 by 3 units and then rotate M about f3 by π radians. Find [m1]F after the composite transformation.

118

119 of 153

Solution:

119

120 of 153

Solution:

120

121 of 153

Example: Composite Transformation

  • Let F = {f1, f2 ,f3) and M ={m1, m2, m3) be two initially coincident fixed and mobile orthonormal coordinate frames, respectively. Suppose we rotate M about f3 by π radians then translate M along f2 by 3 units. Find [m1]F after the composite transformation.

121

122 of 153

Solution:

122

123 of 153

Solution:

123

124 of 153

  • Inverse Rotation:

  • Inverse Translation:

124

125 of 153

Inverse Homogeneous Transformation

125

126 of 153

Example: Inverse Transformation

  • Let F = {f1, f2 ,f3) and M ={m1, m2, m3) be two initially coincident fixed and mobile orthonormal coordinate frames. The homogeneous coordinate transformation matrix which maps mobile M coordinates into fixed F coordinates is given. Find the homogeneous coordinate transformation which maps fixed F coordinates into mobile M coordinates, and use it to find [f2]M.

126

127 of 153

127

128 of 153

Solution:

128

129 of 153

Screw Transformation

129

130 of 153

Screw pitch

  • λ = 0: pure rotation with infinite pitch
  • ф = 0: pure translation is a screw with a zero pitch
  • ρ is positive: screw is right-handed
  • ρ is negative: screw is left-handed

130

131 of 153

Inverse Screw Transformation

  • Screw Transformation:

  • Inverse Screw Transformation:

131

132 of 153

Example: Screw Transformation

  • Let F = {f1, f2 ,f3) and M ={m1, m2, m3) be two initially coincident fixed and mobile orthonormal coordinate frames, respectively. Suppose we perform a screw transformation along axis f2 translating by a distance of λ = 3 and rotating by an angle of π/2. Find [m3]F following the screw transformation and determine the pitch of the screw.

132

133 of 153

Solution:

133

134 of 153

Solution:

134

135 of 153

Joint parameters

135

136 of 153

Link parameters

136

137 of 153

Link parameters

137

138 of 153

Normal, Sliding and Approach Vectors

138

139 of 153

D-H algorithm

139

140 of 153

Link-Coordinate Transformation

140

141 of 153

Inverse Link-Coordinate Transformation

141

142 of 153

Arm Matrix

  • Composite homogeneous coordinate transformation matrix to transform from coordinate frame k to coordinate frame k - 1 .
  • By multiplying several of coordinate transformation matrices together (Rotation, Translation, Link, Joint)

142

143 of 153

Position and Orientation of Tool

143

144 of 153

144

145 of 153

Arm Equation

145

146 of 153

Four-axis SCARA Robot (Adept One)

146

147 of 153

147

148 of 153

148

149 of 153

149

150 of 153

150

151 of 153

Position of the Tool tip

151

152 of 153

Example: Position of the Tool tip

  • Find the position of the tool tip of the Adept One robot when the joint variables are

152

153 of 153

Solution:

153