robotics i - università di romadeluca/rob1_en/writtenexamsrob1/robotics1_… · robotics i june...

4
Robotics I June 10, 2014 Consider the COMAU RACER 7-1.4 robot in Fig. 1. The robot has six revolute joints and a spherical wrist. As shown in the data sheet, each joint has a limited range (called ‘stroke’), which is specified in terms of the COMAU manufacturer convention used for defining the joint variables. (D) (A) (A) (E) (C) (B) Structure / n° axes Maximum payload Additional load on forearm Anthropomorphous / 6 axes 7 kg 10 kg MODEL RACER 7-1.4 Maximum horizontal reach Robot weight Repeatability Tool coupling flange Axis 1 Axis 2 Axis 3 Axis 4 Axis 5 Axis 6 +/- 165° ( 220 °/s) -85° / + 155° ( 250 °/s) 0° / - 170° ( 300 °/s) +/- 210° ( 550 °/s) +/- 135° ( 550 °/s) +/- 2700° ( 600 °/s) 1436 mm 160 kg +/- 0,05 mm Stroke / (Speed) Motors Position measurement system Total power installed AC brushless encoder 3KVA Assembly position A B C D E Floor Ceiling Sloped (45° max) 1716 mm 1436 mm 412 mm 1134 mm 801 mm Operating area Figure 1: COMAU RACER 7-1.4 robot (taken from the data sheet) Figure 2 (in the following page) shows a more detailed drawing of the robot workspace, with all relevant metric data (in mm or deg). For seven different Cartesian positions of the center W of the spherical wrist, a table reports the numerical values of the absolute coordinates X and Z of the point W and of the joint variables of axes 1 and 2. For the calibration position #7, the values of the complete joint configuration vector are reported. Assign the robot frames according to the Denavit-Hartenberg convention and define the nu- merical values in the associated table of DH parameters. On the provided extra sheet (a replica of Fig. 2), draw clearly the DH frames, put your name, and return the sheet with the rest of your solution. When comparing the joint variables according to the DH assignment with those used by the robot manufacturer, there may be some differences. Let θ R 6 be the chosen DH variables, and θ C R 6 be the variables used by the COMAU manufacturer. Using the information in the data sheet, show that the two set of variables are related by the affine map θ C = θ C,0 + , S = diag{s i ,i =1,..., 6}, s i = {+1, -1}, (1) where θ C,0 R 6 is the value of the COMAU variables corresponding to θ = 0 (the zero configuration of the DH joint variables). The signs of the unitary elements s i , i =1,..., 6, on the diagonal of matrix S are used to realign the sense of rotations in the two conventions. Find the actual values of vector θ C,0 and of the diagonal elements of matrix S. [180 minutes; open books] 1

Upload: phamtruc

Post on 06-Feb-2018

220 views

Category:

Documents


0 download

TRANSCRIPT

Robotics IJune 10, 2014

Consider the COMAU RACER 7-1.4 robot in Fig. 1. The robot has six revolute joints and aspherical wrist. As shown in the data sheet, each joint has a limited range (called ‘stroke’), whichis specified in terms of the COMAU manufacturer convention used for defining the joint variables.

(D)

(A)

(A)

(E)

(C)

(B)

COMAU GLOBAL NETWORK

Designed to Perform

Arc

Wel

ding

Ass

embl

y

Cos

met

ic

Sea

ling

Fou

ndry

Han

dlin

g

Pac

kagi

ng

Mac

hine

Te

ndin

g

Mea

surin

g

Te

stin

g

Pol

ishi

ng

Deb

urrin

g

ROBOT APPLICATIONS

Structure / n° axesMaximum payload

Additional load on forearmTorque on axis 4Torque on axis 5Torque on axis 6

Maximum horizontal reachRobot weightRepeatability

Tool coupling fl angeMotors

Position measurement systemTotal power installed

Protection classWorking temperatureStorage temperature

Assembly position

Axis 1Axis 2Axis 3Axis 4Axis 5Axis 6

ABCDE

Anthropomorphous / 6 axes 7 kg10 kg

13 Nm 13 Nm 7,5 Nm

+/- 165° ( 220 °/s)-85° / + 155° ( 250 °/s) 0° / - 170° ( 300 °/s) +/- 210° ( 550 °/s)

+/- 135° ( 550 °/s) +/- 2700° ( 600 °/s)

1436 mm160 kg

+/- 0,05 mmISO 9409 - 1 - A 40

AC brushlessencoder

3KVAIP 65

5 °C ÷ + 45 °C-40 °C ÷ + 60 °C

Floor Ceiling

Sloped (45° max)1716 mm1436 mm 412 mm1134 mm 801 mm

Stroke / (Speed)

Operating area

MODEL RACER 7-1.4

EN

Sales • +39 011 0045406 • [email protected] • +39 011 0045479 • [email protected]

The information contained in this brochure is supplied for information only. Comau S.p.A. reserves the right to alter specifi cations at any time without notice for technical or commercial reasons. The illustration does not necessarily show the products in their standard version. - 01/14 - Turin

(D)

(A)

(A)

(E)

(C)

(B)

COMAU GLOBAL NETWORK

Designed to Perform

Arc

Wel

ding

Ass

embl

y

Cos

met

ic

Sea

ling

Fou

ndry

Han

dlin

g

Pac

kagi

ng

Mac

hine

Te

ndin

g

Mea

surin

g

Te

stin

g

Pol

ishi

ng

Deb

urrin

g

ROBOT APPLICATIONS

Structure / n° axesMaximum payload

Additional load on forearmTorque on axis 4Torque on axis 5Torque on axis 6

Maximum horizontal reachRobot weightRepeatability

Tool coupling fl angeMotors

Position measurement systemTotal power installed

Protection classWorking temperatureStorage temperature

Assembly position

Axis 1Axis 2Axis 3Axis 4Axis 5Axis 6

ABCDE

Anthropomorphous / 6 axes 7 kg10 kg

13 Nm 13 Nm 7,5 Nm

+/- 165° ( 220 °/s)-85° / + 155° ( 250 °/s) 0° / - 170° ( 300 °/s) +/- 210° ( 550 °/s)

+/- 135° ( 550 °/s) +/- 2700° ( 600 °/s)

1436 mm160 kg

+/- 0,05 mmISO 9409 - 1 - A 40

AC brushlessencoder

3KVAIP 65

5 °C ÷ + 45 °C-40 °C ÷ + 60 °C

Floor Ceiling

Sloped (45° max)1716 mm1436 mm 412 mm1134 mm 801 mm

Stroke / (Speed)

Operating area

MODEL RACER 7-1.4

EN

Sales • +39 011 0045406 • [email protected] • +39 011 0045479 • [email protected]

The information contained in this brochure is supplied for information only. Comau S.p.A. reserves the right to alter specifi cations at any time without notice for technical or commercial reasons. The illustration does not necessarily show the products in their standard version. - 01/14 - Turin

(D)

(A)

(A)

(E)

(C)

(B)

COMAU GLOBAL NETWORK

Designed to Perform

Arc

Wel

ding

Ass

embl

y

Cos

met

ic

Sea

ling

Fou

ndry

Han

dlin

g

Pac

kagi

ng

Mac

hine

Te

ndin

g

Mea

surin

g

Te

stin

g

Pol

ishi

ng

Deb

urrin

g

ROBOT APPLICATIONS

Structure / n° axesMaximum payload

Additional load on forearmTorque on axis 4Torque on axis 5Torque on axis 6

Maximum horizontal reachRobot weightRepeatability

Tool coupling fl angeMotors

Position measurement systemTotal power installed

Protection classWorking temperatureStorage temperature

Assembly position

Axis 1Axis 2Axis 3Axis 4Axis 5Axis 6

ABCDE

Anthropomorphous / 6 axes 7 kg10 kg

13 Nm 13 Nm 7,5 Nm

+/- 165° ( 220 °/s)-85° / + 155° ( 250 °/s) 0° / - 170° ( 300 °/s) +/- 210° ( 550 °/s)

+/- 135° ( 550 °/s) +/- 2700° ( 600 °/s)

1436 mm160 kg

+/- 0,05 mmISO 9409 - 1 - A 40

AC brushlessencoder

3KVAIP 65

5 °C ÷ + 45 °C-40 °C ÷ + 60 °C

Floor Ceiling

Sloped (45° max)1716 mm1436 mm 412 mm1134 mm 801 mm

Stroke / (Speed)

Operating area

MODEL RACER 7-1.4

EN

Sales • +39 011 0045406 • [email protected] • +39 011 0045479 • [email protected]

The information contained in this brochure is supplied for information only. Comau S.p.A. reserves the right to alter specifi cations at any time without notice for technical or commercial reasons. The illustration does not necessarily show the products in their standard version. - 01/14 - Turin

(D)

(A)

(A)

(E)

(C)

(B)

COMAU GLOBAL NETWORK

Designed to Perform

Arc

Wel

ding

Ass

embl

y

Cos

met

ic

Sea

ling

Fou

ndry

Han

dlin

g

Pac

kagi

ng

Mac

hine

Te

ndin

g

Mea

surin

g

Te

stin

g

Pol

ishi

ng

Deb

urrin

g

ROBOT APPLICATIONS

Structure / n° axesMaximum payload

Additional load on forearmTorque on axis 4Torque on axis 5Torque on axis 6

Maximum horizontal reachRobot weightRepeatability

Tool coupling fl angeMotors

Position measurement systemTotal power installed

Protection classWorking temperatureStorage temperature

Assembly position

Axis 1Axis 2Axis 3Axis 4Axis 5Axis 6

ABCDE

Anthropomorphous / 6 axes 7 kg10 kg

13 Nm 13 Nm 7,5 Nm

+/- 165° ( 220 °/s)-85° / + 155° ( 250 °/s) 0° / - 170° ( 300 °/s) +/- 210° ( 550 °/s)

+/- 135° ( 550 °/s) +/- 2700° ( 600 °/s)

1436 mm160 kg

+/- 0,05 mmISO 9409 - 1 - A 40

AC brushlessencoder

3KVAIP 65

5 °C ÷ + 45 °C-40 °C ÷ + 60 °C

Floor Ceiling

Sloped (45° max)1716 mm1436 mm 412 mm1134 mm 801 mm

Stroke / (Speed)

Operating area

MODEL RACER 7-1.4

EN

Sales • +39 011 0045406 • [email protected] • +39 011 0045479 • [email protected]

The information contained in this brochure is supplied for information only. Comau S.p.A. reserves the right to alter specifi cations at any time without notice for technical or commercial reasons. The illustration does not necessarily show the products in their standard version. - 01/14 - Turin

(D)

(A)

(A)

(E)

(C)

(B)

COMAU GLOBAL NETWORK

Designed to Perform

Arc

Wel

ding

Ass

embl

y

Cos

met

ic

Sea

ling

Fou

ndry

Han

dlin

g

Pac

kagi

ng

Mac

hine

Te

ndin

g

Mea

surin

g

Te

stin

g

Pol

ishi

ng

Deb

urrin

g

ROBOT APPLICATIONS

Structure / n° axesMaximum payload

Additional load on forearmTorque on axis 4Torque on axis 5Torque on axis 6

Maximum horizontal reachRobot weightRepeatability

Tool coupling fl angeMotors

Position measurement systemTotal power installed

Protection classWorking temperatureStorage temperature

Assembly position

Axis 1Axis 2Axis 3Axis 4Axis 5Axis 6

ABCDE

Anthropomorphous / 6 axes 7 kg10 kg

13 Nm 13 Nm 7,5 Nm

+/- 165° ( 220 °/s)-85° / + 155° ( 250 °/s) 0° / - 170° ( 300 °/s) +/- 210° ( 550 °/s)

+/- 135° ( 550 °/s) +/- 2700° ( 600 °/s)

1436 mm160 kg

+/- 0,05 mmISO 9409 - 1 - A 40

AC brushlessencoder

3KVAIP 65

5 °C ÷ + 45 °C-40 °C ÷ + 60 °C

Floor Ceiling

Sloped (45° max)1716 mm1436 mm 412 mm1134 mm 801 mm

Stroke / (Speed)

Operating area

MODEL RACER 7-1.4

EN

Sales • +39 011 0045406 • [email protected] • +39 011 0045479 • [email protected]

The information contained in this brochure is supplied for information only. Comau S.p.A. reserves the right to alter specifi cations at any time without notice for technical or commercial reasons. The illustration does not necessarily show the products in their standard version. - 01/14 - Turin

Figure 1: COMAU RACER 7-1.4 robot (taken from the data sheet)

Figure 2 (in the following page) shows a more detailed drawing of the robot workspace, with allrelevant metric data (in mm or deg). For seven different Cartesian positions of the center W ofthe spherical wrist, a table reports the numerical values of the absolute coordinates X and Z ofthe point W and of the joint variables of axes 1 and 2. For the calibration position #7, the valuesof the complete joint configuration vector are reported.

• Assign the robot frames according to the Denavit-Hartenberg convention and define the nu-merical values in the associated table of DH parameters. On the provided extra sheet (areplica of Fig. 2), draw clearly the DH frames, put your name, and return the sheet with therest of your solution.

• When comparing the joint variables according to the DH assignment with those used by therobot manufacturer, there may be some differences. Let θ ∈ R6 be the chosen DH variables,and θC ∈ R6 be the variables used by the COMAU manufacturer. Using the information inthe data sheet, show that the two set of variables are related by the affine map

θC = θC,0 + S θ, S = diag{si, i = 1, . . . , 6}, si = {+1,−1}, (1)

where θC,0 ∈ R6 is the value of the COMAU variables corresponding to θ = 0 (the zeroconfiguration of the DH joint variables). The signs of the unitary elements si, i = 1, . . . , 6,on the diagonal of matrix S are used to realign the sense of rotations in the two conventions.Find the actual values of vector θC,0 and of the diagonal elements of matrix S.

[180 minutes; open books]

1

Figure 2: The workspace of the COMAU RACER 7-1.4, with the data associated to the wristcenter positions (labeled from 1 to 7)

2

SolutionJune 10, 2014

z0 x0

y1

x1

x2 y2

z3

x3 z5

y4

x4

x5

x6

z6

Figure 3: Assignment of Denavit-Hartenberg frames for the COMAU RACER 7-1.4 robot

i αi ai di θi

1 −π/2 a1 > 0 d1 > 0 θ1

2 0 a2 > 0 0 θ2

3 −π/2 a3 > 0 0 θ3

4 π/2 0 d4 > 0 θ4

5 −π/2 0 0 θ5

6 0 0 0 θ6

Table 1: Denavit-Hartenberg parameters associated to the frame assignments in Fig. 3

3

A possible DH frame assignment is shown in Fig. 3, with the associated parameters given in Table 1.The actual numerical values are (in mm):

a1 = 150, d1 = 430, a2 = 590, a3 = 130, d4 = 684.

The configuration θ = 0 of the chosen DH convention corresponds to the COMAU angles (indeg):

θC,0 =(

0 +90 −90 0 0 0)T.

The diagonal elements matrix S are:

S = diag {−1,+1,−1,−1,+1,−1} .

One can also reverse eq. (1), by multiplying it by S and noting that S2 = I. We obtain

θ = −S θC,0 + S θC = θ0 + S θC , S = diag{si, i = 1, . . . , 6}, si = {+1,−1}. (2)

Thus, the value θ0 ∈ R6 of the DH joint variables corresponding to θC = 0, the zero configurationof the COMAU variables, is given by:

θ0 = −S θC,0 =(

0 −90 −90 0 0 0)T. (3)

Finally, Table 2 compares the feasible joint ranges (in deg) in the two notations. For θ, insteadof reporting the min and max values (in increasing order), we preferred to use the notation lim1

and lim2 (corresponding, respectively, to the lower and upper limits of θC). In this way, we takeinto account the possible reverse sense of rotation of the joints (i.e., when si = −1 for joint i) inthe two conventions. Note that almost all limits in the fourth and fifth columns of this table canbe computed directly using eqs. (2) and (3). Joint 5 is an exception: a +90◦ should be addedbecause of the special placement of the x5 axis in the θ5 = 0 configuration w.r.t. the actual jointrange.

i min θC,i max θC,i lim1 θi lim2 θi

1 −165◦ 165◦ 165◦ −165◦

2 −85◦ 155◦ −175◦ 65◦

3 −170◦ 0◦ 80◦ −90◦

4 −210◦ 210◦ 210◦ −210◦

5 −135◦ 135◦ −45◦ 225◦

6 −2700◦ 2700◦ 2700◦ −2700◦

Table 2: Joint ranges in the COMAU and DH conventions

∗ ∗ ∗ ∗ ∗

4