86
Example: Assigning Coordinate Systems According DH Notation Robotics Example: Assigning Coordinate Systems According DH Notation Vladimír Smutný Center for Machine Perception Czech Institute for Informatics, Robotics, and Cybernetics (CIIRC) Czech Technical University in Prague 1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55

Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

  • Upload
    others

  • View
    4

  • Download
    0

Embed Size (px)

Citation preview

Page 1: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Example: Assigning Coordinate Systems According DH Notation

RoboticsExample: Assigning Coordinate Systems According

DH Notation

Vladimír Smutný

Center for Machine Perception

Czech Institute for Informatics, Robotics, and Cybernetics (CIIRC)

Czech Technical University in Prague

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 2: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 3: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 4: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 5: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Determine axes of individualjoints. Choose one of linesparallel to motion axis forprismatic joints (2 DOF cho-ice). This robot does not haveprismatic joint.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 6: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

i4

i3

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 7: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Find transversals of the con-secutive axes.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 8: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

i4

i3

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 9: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 10: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

i4

i3

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 11: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Label the first endpoint ofthe i-th transversal by Hi

and the second endpoint ofthe transversalOi. ChooseO0

anywhere on z1 (1 DOF cho-ice). Choose O6 anywhere (3DOF choice).

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 12: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 13: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

The transversal between pa-rallel axes i2 and i3 has 1DOF. We have chosen O6 tolie on i6 in the center of theflange.

Next step:Place z0 axis into axis i1.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 14: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 15: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place x0 perpendicularly tothe z0 (1 DOF choice).

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 16: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

x0

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 17: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place y0 to form positively ori-ented system.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 18: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 19: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place z1 axis into axis i2.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 20: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 21: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place x1 as extension of thetransversal H1O1.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 22: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2 x1

O2=H3=O3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 23: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place y1 to form positively ori-ented system.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 24: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

O1=H2 x1

O2=H3=O3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 25: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place z2 axis into axis i3.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 26: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

O1=H2 x1

O2=H3=O3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 27: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place x2 as extension of thetransversal H2O2.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 28: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

O1=H2 x1

O2=H3=O3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 29: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place y2 to form positively ori-ented system.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 30: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y2

O1=H2 x1

O2=H3=O3

x2

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 31: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place z3 axis into axis i4.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 32: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y2

O1=H2 x1

O2=H3=O3

x2

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 33: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place x3 perpendicularly to i3and i4 as H3 = O3.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 34: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y2

O1=H2 x1

O2=H3=O3

x2

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 35: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place y3 to form positively ori-ented system.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 36: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z3

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 37: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place z4 axis into axis i5.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 38: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z3

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 39: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place x4 perpendicularly to i4and i5 as H4 = O4.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 40: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z3

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 41: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place y4 to form positively ori-ented system.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 42: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z3

x4

x0

y0

y4

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 43: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place z5 axis into axis i6.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 44: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z3

x4

x0

y0

y4

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 45: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place x5 perpendicularly to i5and i6 as H5 = O5.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 46: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z3

x4

x0

y0

y4

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 47: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place y5 to form positively ori-ented system.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 48: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z5

z3

x4

x0

x5

y0

y4

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 49: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place z6 axis arbitrarily (2DOF choice).

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 50: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z5

z3

x4

x0

x5

y0

y4

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 51: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

We have chosen z6 in the di-rection of i6.

Next step:Place x6 axis arbitrarily (1DOF choice).

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 52: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z5

z3

x4

x0

x5

y0

y4

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 53: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

Next step:Place y6 to form positively ori-ented system.

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 54: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z5

z3

z6

x4

x0

x5

x6

y0

y4y6

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 55: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

Staubli Robot Paint TX250 D-H notation

i1

i2

i5

i6

z2

z5

z3

z6

x4

x0

x5

x6

y0

y4y6

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

i θi di ai αi1 θ1 550 150 π

2

2 θ2 0 1025 π2

3 θ32219−1025 0 π

4

4 θ4 88√2 0 −π4

5 θ5

1375+1025−2219−88

0 0

6 θ6 0 0 0

1 23 45 67 89 1011 1213 1415 1617 1819 2021 2223 2425 2627 2829 3031 3233 3435 3637 3839 4041 4243 4445 4647 4849 5051 5253 5455

Page 56: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and
Page 57: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and
Page 58: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and
Page 59: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

i4

i3

Page 60: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

i4

i3

Page 61: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and
Page 62: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

i4

i3

Page 63: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

Page 64: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

z0

Page 65: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

x0

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

z0

Page 66: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

z0

Page 67: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2

O2=H3=O3

i3

z1

z0

Page 68: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

H1

O1=H2 x1

O2=H3=O3

i3

z1

z0

Page 69: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

O1=H2 x1

O2=H3=O3

i3

z1

z0

Page 70: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

O1=H2 x1

O2=H3=O3

i3

z1

z0

Page 71: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

O1=H2 x1

O2=H3=O3

i3

z1

z0

Page 72: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y2

O1=H2 x1

O2=H3=O3

x2

i3

z1

z0

Page 73: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y2

O1=H2 x1

O2=H3=O3

x2

i3

z1

z0

Page 74: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y2

O1=H2 x1

O2=H3=O3

x2

i3

z1

z0

Page 75: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z3

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 76: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z3

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 77: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z3

x0

y0

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 78: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z3

x4

x0

y0

y4

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 79: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z3

x4

x0

y0

y4

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 80: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z3

x4

x0

y0

y4

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 81: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z5

z3

x4

x0

x5

y0

y4

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 82: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z5

z3

x4

x0

x5

y0

y4

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 83: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z5

z3

x4

x0

x5

y0

y4

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 84: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z5

z3

z6

x4

x0

x5

x6

y0

y4y6

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0

Page 85: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and
Page 86: Robotics - CMPcmp.felk.cvut.cz/cmp/courses/ROB/roblec/DH-Staublieng.pdfStaubli Robot Paint TX250 D-H notation Nextstep: Label the first endpoint of the i-th transversal by H i and

i1

i2

i5

i6

z2

z5

z3

z6

x4

x0

x5

x6

y0

y4y6

y5

z4

i4

H6=O6

H5=O5

H4=O4

O0

y1

H1

y3

y2

O1=H2 x1

O2=H3=O3

x2x3

i3

z1

z0