连杆i

θ i

α i 1

d i

a i 1

1

θ 1

0

0

0

2

θ 2

-pi/2

d 2

0

3

θ 3

0

0

a 2

4

θ 4

-pi/2

d 4

a 3

5

θ 5

Pi/2

0

0

6

θ 6

-pi/2

0

0