“ ROBOTS HEXÀPODES: ESTUDI I IMPLEMENTACIÓ”

AUTORS: FRANCESC FARRAN SAPERAS JORDI RIBERA FÀBREGAS JENARO CÁTEDRA MARTÍNEZ

TITULACIÓ: ENGINYERIA TÉCNICA EN ELECTRÒNICA INDUSTRIAL

DIRECTOR: PERE PONSA ASENSIO

DEPARTAMENT: ESAII

DATA: 03 de juny del 2003

!

!

" !

#

$ !

! %

&'

( ( )

* +

, +

-

!"!# $

#%#!&'( $

! $)*

!#%

#+#" *),

- ! # ,).

!#+/0 .)

$ !!#

# )

- (#!&'( -

-1# -

- '!

-

- % $

-- # *

- !&'(*

- # ,

1 #"#!&'( .

.

% .

#

- $

/ *

/ 2

-

- -*

3 ( -,

- # 1

- #µµµµ

$1#!&'( $-

$# %#

#"( $-

$ 4'! $

$- % #! $,

$ #! *-

*1# *

21!!#0% *$

.

1

56789:;<

/ % 0

#

" 1

"/0

!

0

/!23

#

/ 0 1

"

=>?;:?789:;

/ '40 /

1

! '" $

"/

'1'

% 536

)0'"'

)0 ,7% !

!#

!11

%8*,

9

!"!#

)!116

(

(

)6

: )3

;< :1

= :

>? :

#%#!&'(

#

1

!

!

2 !

" 4@0

'#'

# %/

(A:AB8*,8CD CB8AC,E,B +

F GA F !

4"#1

B

)4 #

2

?

!

!#%#+#"

2#!!

0%

' 430 % #

431

! -8

H?IJ./!

K

! ''.

-H?IJ.!

B4'234

'

F'

J@9 H@H@9

J

"#

-! #

GD= 2 "

L

GD0#4!

#/F !

0 <

! GD

:=:?789:; :=:?;?0/

, ? -.

*

/

: :

)" + +

* + :

+ +:

* * C

B0

% G

+ +

@

M# 1

#0!#

'

6

A!1

1

$%&'(

!#+/0

2 !

$ ! 0

!C,,#

!'

# 1

1

$

'

!!1

HN

5 0C,

G%D

%G

07 ?7@;

B +?

)" F C

* + C

!<

C ,

*

:

0 + +

C#!

+ :

')

HH

')#

$!!##

' F' 4

21 "

!<

'" '"!

*+ , -.

* / 0.1

H

OP #

OP!!

"

#

< '!

F

56

*$

H-

-(#!&'(

-1#

4#!!4

6

H/

/F

-/

!#

0

-#(

42&4

HNN0QR0=0!6

& 44 !

4' 3

& /

& !

! '

6

TIPUS DE PLÀSTIC #AB

:,2 2

+ # #

L<

L

L#F GA$#

1

! #

! L

/

*1

,! 1 !

<

14

% 4#

C0

C0 4 ! 4

4 # <

3

H.

TIPUS DE PLÀSTIC #AB

I1

A 4

!4

4 "

!3

F<!14

1

%

* 1

4 3

%3

34 4#

!L'

4

%3+ 3 1 4 4

%4

L 4 # <

' 4

4 4

,

% L # 2 4

%D*"2-2)L #

3

,L #

$3 . # " "4 5 ""

=2 !6

$

H9

- %

441

144 14

#% AB

*

F4

4

C5?@?DE??F;

9?FG;+??;:=:?

1

#

4

1

)#

#

'

3 1 4

1 #!

4

$3."" #

H?

--#

4!'

3

#!4

# 1 1

1 '

F&

#! !

2

$$5." 6..

- 1 !&'(

F'4

4"'

!0

01!#

,!

'

1

!4# 6

H/S

/S=

HK

'0 #

*

4

4 !

! ?

F 1

54"

78-.

*

4

4

54".

"#

" "

HJ

'&'0#

$39 ." )54"

- #

F '

1

# !

"B43'1!

1

' #

!

,

1

H@

#"#!&'(

:

#1 C

56

,'

,!

,

:@:>:

:;D

6

#!'14

'F

!"!;

'4>'

F*%$

'

F#!'1!

#

%4!''!

1&!

:@:>:

'!"53@NN/1

F< ' 1 '

! 2 F 1 4

4&53.NT=#

F.NT=#0 10

0531!! 1

4 0 .NT=# OP'

'!.N/U#

N

??:@:>;:HG

F!

'"'B 4'

' F

#!

3

'$ ,.:#;

D:

F5'

999 !(H4 '53 F

#4C%CC$F )4

;F )''4

*&!0

.NU=#

H

'$ ,. . /#;

(6

1!4 8(+/JNF534

-K@U#-U#>/H9U#;10

F4&C%CF4"

F ) 0

'$$ ,."/#;

5',+(B *

'$$'8 . /#;

:;+?:

#!<44

!

! 210%

1 !#%

' '

F-N &

-?NV

&

' ,.:< :.

-

%1 !1

&! 1 !*

< 3 ! '" '

1 1

''

0 .NU=#1$

/;

4 ; 4

(6

1*+A,F4J

!K.H1

F 0

'7"/

! ?9 $H F!

!D9D

'$."#"#'

.

D:;+?:

42999(4!

.UΩ4#3!

'' ,.. /

!5'

16

'*8 /

9

-I!J

!33

! = 1 *

-N

N 4

#'5 1

'$5." .!%+=8%

'$ #5.

0 %#' /#I'J

NG($, HNUΩ

@NG($, NUΩ

W@NG($, -NX.NUΩ

'$$:#59 -

?

/

!43

F 4

!' !

"%/#

!

!

DCBBG , 8C*ACD C8 CB,

, Y

YH

YC%R+

+ Y

Y.

53

+* Y(!

Y*

Y 8

Y%"

'1

YZ

YG Y)0

Y)

YC

YG

0

#

0%

/3-

,

6

' ..-. "

K

/

$ 4 ! 4

#/!

F!4!

& ! 3

0 34 0 %R+1

F03

!'/!

344<

3!%R+6

0D!0DH

.H!3D/D

44

D

4DDH/D[N0

40 /XDXD\ND4

4DHDDH/DWN04

0 />DD\DF

0D 0 3

4D4D4'D

!&!

D>D XD .H- .H.F

>DXD !D,D4

>D 4XD4 D4

%5!6D'53

0 !

!

J

' ,./.>%

Time

15.0ms 15.5ms 16.0ms 16.5ms 17.0ms 17.5ms 18.0ms 18.5ms 19.0ms 19.5msV(V1) V(V2) V(Vcc)

0V

2.0V

4.0V

5.5VAmplitud

'5 2,? @? @

Time

10.0ms 10.5ms 11.0ms 11.5ms 12.0ms 12.5ms 13.0ms 13.5ms 14.0ms 14.5msV(Vref) V(V2) V(Vout)

0V

2.5V

5.0VAmplitud

'$5 2 ? @."A*(B? #A*(B @

@

Time

10.0ms 10.5ms 11.0ms 11.5ms 12.0ms 12.5ms 13.0ms 13.5ms 14.0ms 14.5msV(Vref) V(V2) V(Vout)

0V

2.5V

5.0VAmplitud

*'5 2 ? @."A*B? #A*B @

!

4!3!

%R+! &

!!3

'* 5/ -.

*4 !

!

4H

H9

-N

'C: 2./

L!4

!456,

!1 !"

, " !

%

!2%R+'

!#

!44

04

<

-H

'D# -. #:

3

334

4 4

3 ( 4

3CA()/,$)

,$)/CA() $ 1 !

3

,

,!-6

• 864#

• ( 6 % "

! ! 3 3

3 !

1F#!4

• =6 ,! ! 6 2

"

,

• :6

• $6 44

:56

2 ,

-

1!"

!

'"#.."

4 34)

.#!1

!%

353

'7."

--

4

F53

!&.-

'$"#.."'

F

)4<9

1

! I 53

!

''7."" . "

* @NV 4

!

4$!44#!

3#

44

4!

-.

53

56

%"

!6

%6"

* 53

!

+6

!"

!.6

,0

*

3

+

%%

*

-9

'* ":."

,H , ,- ,.

H S S

S

- S S

. S

9 S S

? S

K S S

J S

H S S

-?

F ! 4

'

-

$3 4#!

3

3!

4 !

4 1 3

4

! /

%!3

8! 8 !3

: * "I

" R

'3

'$5/.

! '

!6

-K

'$8,EF#./)54".. 77

4 #1

F'4 4"

#;!"

41040

'$$;1

$

$ !4

!!

!

'$' ,..".-/

* *%R+

* =

-J

*4/#

]4=,

#!

'$*# . /

'$C7-"..;G..:

+ (

# 10 4"

OU/P4-?-?

'' ..".4H9) $+8

-@

'"

40%R+1

!

''/".. ".4

''$"#./ ".4

.N

-#F 4<

%0

OP <

1 0

4

1

( #

4 ' 3

6

• %

• +1(+

• +1(A+]%(A+] %(A+

• F ,

• +136B#3*)*)

• G#

F!4

!4

,

53 #

'$+: I.

% 6

/

! 4

!4

.H

I:(8*CB +A) F,8 JN.JJN9HJN*H@?JNHJ?JNHJJJN-J? S+ ?JN9?J=*HH?J=*H?J=*H??J-SS= =)?.HJN% G1JN9H,G,/B ,B/?SS+ %8*C, *A%.NN*A%JNN J J?SSB8 B+,-KNB ?J=*HH

'$ # . .

!!56

• *• D• I<• 8!• '• %!

- ##%!114 '4<

%8*!!

) %8*# %8*6 G

G'G)%

! 5!6

• +1 %(A+] %(A+

• C

• B#

• I!

.

'$70 , .. . +7

.-

*444%8*;4

4!4%8*4

%8* , %8* 4 1 4

4#53 <

#4 3 F! %8* 4 3

%8* ! ' %

3%8*

'4F<<%8*,!

<%8*%!

'

%= %8*H?*J.+_

*/

#

7]7

'$+7C7&'

)!!6

• /;;6 !-?

• /6B

• K#L6 ;#

• K#L 6, (/*`IH

• /99K M#6 ( 4!D#

!

• 1KK K-6 ]

• 6 B4B+(N

• !1K6 /3

%8*#!NU:

$#

#3#!B44

!

• !K! K!-6

..

• !K!$K!*K!26 4!

F!6

• !N:%:N]8CB1NH

• *.K:!

A4

• )#B+(N

!6

H D9:?F;: 1 N6 N 4 J

'%

# ;

#!IINN

8CB*AC BN8I , 9 H !

!$3!BN8I7

?9:6$!!#

!)3!

- :?;+?;:?; %8*H?*J.:]H-

44

(.(:N(:.(:K 49

B(8,4

!4

%:B4414J

3 3 #!

'"1!4

.K!

53&H(:.

B+(N

: B+(N % 1

3 ! !

0

(A%B8ACa( G"JHH6 4(R

453B+(NRB*=)AG

8CB /%A(B:

:K :N

](:%$ 8CB )G BN*, BN, %, %, %,H %,N

(]R (]R (]R (]R (]R (]R (]R (]R

.9

](:%$4

:K](:%$! /:

N\*

:?8CB )G6B!

H\(:N]8CB

N\(:N]8CB

:9BN*,IB+(N

H\%2BA*UH

N\%IA,*].#

:.BN, 6BBN*UH

H\8B+(N

N\8B+(N

:-%,!53

H\R

N\B+(N

:HN%,%,H%,ND53

%, %,H %,N )B+(N )R)B

N N N H6 H6H

N N H H6. H6

N H N H6J H6.

N H H 6H? H6J

H N N H6- H6H?

H N H H6?. H6-

H H N H6HJ H6?.

H H H H69? H6HJ

8CB*AC

0##!3

!

:K :N

G8 % 8 BNH 8CB (:8 BN8I 8CBI (:8I

(]R (]R (]R (]R (]R (]R (]R (]R

:KG8 6!+!N

!

H\*

N\*&

:?% 8 6!!3

H\

.?

N\)

:9BN8 6!!B+(N

H\

N\)

:.8CB !!

H\

N\)

:-(:8 !!%:

H\8!

N\8!

:BN8I,0#!B+(N

H\B+(N

N\B+(N

:H8CBI,7!

H\F! 7

N\C!

:N(:8I,0#:

H\;:K. 7

N\*%:

B(8,"J9"N9!

!

:K :? :9 :. :- : :H :N

% (.]BN*UH (- ( (H (N

B(8, B(8,. B(8,- B(8, B(8,H B(8,N

%B(8,7B(8,7\N

N %/HH

)]

!

'

B(8,:"J?:"N?4!

!

:K :? :9 :. :- : :H :N

%: (:K (:? (:9 (:. (:- (: (:H (:N]8CB

B(8,: B(8,:K B(8,:? B(8,:9 B(8,:. B(8,:- B(8,: B(8,:H B(8,:N

.K

4B(8,

I!6

H ,! ]B+(N

%!

NG8

- %*

. %*NNN.4

9 F " 0#

]B+(N

? , !

!

K 0#7#

J ;<!!4( B$(C

%*!H

G8

#

4#

4HN

.J

.@

!!%8*H?*J.

4 3/

9N

9H

%'%8*'

77

• 76

o %

o **:,8*IA(B=

o %!1

o ,

• =76

o ) O/P 1

o ,

o )

o

44 NH

4O'P

!A:Q4&

$ 4

!NH!4!

#! OP4! ,+

,(*$''"

*

%8*48CB 1

%(FFS0

8CB F#JN9H

B40#4:,8**

44&4##'

!*

#!

:,8**

+%*

+%F:/*

*

**9S

%:*:,8*

I:,8*

9

'$$# " ".:

$0/%8*4

!4!

.3!6

• DG 9G6 ,! 3

7#

!F

44 #!4# 4

!

• D;: 7N=;6 ! 7

4 3& %*'2/

F!

• D;:O?P6

%8*

9-

$#!&'(

$

D::?:;:*,'

$# %##"(

%<'!4!4"'

414 ,

' /

'#

* ,.. "/#;

*6 (36

(H\H9U

(\U

(-\9?U

(.\KNU

(9\HU

(\.KU

*6

*H*\.KI

*-\I

*.\HI

*9\HNI

,6

)HF )8(\F)KH

%=HIABAB(C,8,BA(\:%R.

;H\C-@N?

*8H\C 9?K

9.

*

I3

1 <

.F< 4

0

#1!!

3%

1<

4##

%R+

I#4%8*H?*J.<4

!53

$ 4#'A!

F! 4!

!

* "" /

5 4

99

* #"

H-.!'-

/%8*

* " "

* # "

.- -.

9?

'

*$ ""."

*' #"."

,!6

H-.6I

9?KJ@HNHHH!H9

H-H.

H9!

H?HKHJH@ &

NH'

! ?

'

#!4 :,2

2#!F GA'4

F!

/"

9K

** ,." 5

5 6

9J

$-% #!

$ #

0I

56

• )'!

• -256

o )"6

+

o H 2 #6

#

*$5. I -.

*$ ,.

44

* *

, %R+ '" %8* H?*J. %

9@

%R+ %8* # # B+(N

#--#

F '

6

H

%! H9

%!

*$7 -.

$ 6

* *

A

44

A!,

G

6

Y%

Y%

A!,

G

6

Y%

Y%

=&1'!

%R+*&!

34

?N

*$$7: .-. -. ,.

;06

• H

• H 01

*$$82 - ".

% 4

"4

4

?H

*$'"/ ,

G-06

• H

•

*$*82

%146

44

?

*$C"

G-06

• H

•

*$D82

:

00

?-

$ #!&'

?? I??J

% JNY-?N H ?Nb

,I - .b

%H?IJ. H .Jb

C 9?K N-@b

F)KH N9JNb

(:%HN.]:%R. N9-Nb

BC-@N? NN9b

* HN NN.b

%HHNNYH?N H .HHb

( H HHHb

% H N-JJb

% . .J9b

8 H HNb

9:??:? 1.-,,Q

?.

*1#

)4 !

!4 <! '

4!01

4C, G

0%)

! !!!

<F! ! 4

!!4 2#!

11!

F!

! %8*,

!

4

?9

21!!#0%•B(::#%7.I".:J&DI%K

•(L)+-I".:JJ&I%K

•(!0!M.)I#

•+%8*L%0NIL% I%7I#

0R ! #6]]777/]6]]']6]]]']8BG/I]/6]]]6]]777T]6]]777]6]]777]6]]/]]6]]]a]6]]](A:AB6]]777]]6]]777]6]]777]

6]]777]

6]]](A:AB

6]]777]