UNIVERSIDAD ANDINA NESTOR CACERES VELAQUEZ FACULTAD DE CIENCIAS PURAS ESCUELA PROFESIONAL PROFESION AL DE INGENIERIA INGENIE RIA MECATRONICA INFORME DE PORYECTO FINAL (ARAÑA CUADRUPEDA)
PRESENTADO POR: Jimmy Ale!"#e$ M!m!"i %&!$%! DOCENTE: I"' C!$l* C%!m! Pl!"%
PUNO+PERU ,- DE NOVIEM.RE DE /,01
RESUMEN L! !$!2! %3!#$45e#! %"*i*6e 3"! imi6!%i7" #e l! !$!2! e" 8$m! #e 9i#! L! imi6!%i7" 83e 3e !l 9e$ *im5le 9i*6! 5#em* ;*e$9!$ 3e 6ie"e l* $!*'* #e 6e"e$ < 5!6!* %" *3* =* ;ie" e*%"#i#* El 5$ye%6 %"*i*6i7 e" imi6!$l l* mi*m* $!*'* #e 3"! !$!2! #e 9e$#!# E"6"%e* 53#im* &!%e$l 5e$ &3; !l'3"* ;*6>%3l* 3e " "* #e=!$" 5$ 3e " 53#im* *!%!$l !l 0,,? #e *3* $!*'* Se'4" e" el 5$ye%6 &3; !l'3"!* 8!ll!* 3e 53#im* %$$e'i$l me#i!"6e *3 5$'$!m!%i7" %m 6!m;i@" 5$ *3 8$m! me%>"i%! 3e !l'3"!* 5!$6e* 8!ll!;!" 5$ l!* m!l!* i"*6!l!%i"e* 5$ e$$$e* m"im* T!m;i@" 639im* 5e$#i#! #e m!6e$i!le* 5$ " 36iliB!$ l* m!6e$i!le* %$$e*5"#ie"6e* %m '3!"6e* e6% MATERIALES L* m!6e$i!le* 83e$" el *i'3ie"6e: 0 MICR MICRO O SERV SERVOS OS G G DESCRIPCION El *e$9 SG, Te$ P$ 3" *e$9 mi"i!63$! #e '$!" %!li#!# y #imi"36!* #ime"*i"e* !#em>* e* ;!*6!"6e e%"7mi% F3"%i"! %" l! m!y$! #e 6!$=e6 6!$=e6!* !* ele%6$ ele%6$7"i 7"i%!* %!* #e %"6$ %"6$l l %" mi%$% mi%$%"6 "6$l $l!# !#$e* $e* y !#em>* !#em>* %" %" l! m!y$! #e l* *i*6em!* #e $!#i %"6$l %me$%i!le* F3"%i"! e*5e%i!lme"6e ;ie" e" !e$"!9e* #e !e$m#eli*m #!#!* *3* %!$!%6e$*6i%!* #e 6$3e 6!m!2 y 5e* El *e$9 SG, 6ie"e 3" %"e%6$ 3"i9e$*!l 6i5 S 3e e"%!=! 5e$8e%6!me"6e e" l! m!y$! #e l* $e%e56$e* #e $!#i %"6$l i"%l3ye"# l* F36!;! JR GHS Ci$$ Ci$$3* 3* i6e i6e%% y 6$ 6$* * L* L* %!;l %!;le* e* e" el %"e %"e%6 %6$ $ e*6> e*6>" " #i*6 #i*6$i; $i;3i 3i# #** #e l! *i'3i i'3ie" e"6e 6e 8$ 8$m!: m!: R= Ali Alime me" "6!%i 6!%i7" 7" (K) (K) C!8e C!8e Alime lime" "6!% 6!%i7" i7" () () 6ie$$! N!$!"=! Se2!l PHM E*6e 6i5 #e *e$9 e* i#e!l 5!$! l!* 5$ime$!* e5e$ie"%i!* #e !5$e"#iB!=e y 5$>%6i%!* %" *e$9* y! 3e *3* $e3e$imie"6* #e e"e$'! *" ;!*6!"6e ;!=* y *e 5e$mi6e !lime"6!$l %" l! mi*m! 83e"6e #e !lime"6!%i7" 3e el %i$%3i6 #e %"6$l P$ e=em5l *i *e %"e%6! ! 3"! 6!$=e6! !$#3i" *e 53e#e !lime"6!$ #3$!"6e l!* 5$3e;!* #e*#e el 53e$6 US. #el PC *i" m!y$ 5$;lem!
CARACTERISTICAS • •
Mi%$ Se$9 Te$5$ Vel%i#!#: Vel%i#!#: ,0, *e%1, <V
• • • • • •
T$3e: 0 '%m <V Vl6!=e Vl6!=e #e 83"%i"!mie"6: ,-/V Tem5e$!63$! #e 83"%i"!mie"6: , ℃ 1, ℃ "'3l #e $6!%i7": 0, A"%& #e 53l*: ,,/<,, ,,/<,, W* L"'i63# #e %!;le #e %"e%6$: /<%m
PROGRAMACION Xi"%l3#e Se$9& i"6 T$i'Pi" A,[ i"6 E%Pi" A0[ %"*6 3"*i'"e# l"' T$i'Cy%le ,,,,[ %"*6 3"*i'"e# l"' T$i'Si' 0,[ %"*6 3"*i'"e# l"' M!E% /,,,[ %"*6 3"*i'"e# l"' Mi"E% 0/[ 3"*i'"e# l"' T$i'Time$ ,[ i"6 T$i'V!l LOH[ 3"*i'"e# l"' E%I"6e$9!l[ 3"*i'"e# l"' #i*6!"%e[ 3"*i'"e# l"' #i*6!"%eRIGT[ 3"*i'"e# l"' #i*6!"%eLEFT[ %"*6 3"*i'"e# l"' MIN#i*6!"%e ,[ %"*6 3"*i'"e# l"' CRIT#i*6!"%e 0[ Se$9 R+.AC+0[ Se$9 R+FRONT+0[ Se$9 L+FRONT+0[ Se$9 L+.AC+0[ Se$9 R+.AC+/[ Se$9 R+FRONT+/[ Se$9 L+FRONT+/[ Se$9 L+.AC+/[ Se$9 R+.AC+[ Se$9 R+FRONT+[ Se$9 L+FRONT+[ Se$9 L+.AC+[
i"6 R+.AC+0+!"'le[ i"6 R+FRONT+0+!"'le[ R+FRONT+0+!"'le[ i"6 L+FRONT+0+!"'le[ L+FRONT+0+!"'le[ i"6 L+.AC+0+!"'le[ i"6 R+.AC+/+!"'le[ i"6 R+FRONT+/+!"'le[ R+FRONT+/+!"'le[ i"6 L+FRONT+/+!"'le[ L+FRONT+/+!"'le[ i"6 L+.AC+/+!"'le[ i"6 R+.AC++!"'le[ i"6 R+FRONT++!"'le[ R+FRONT++!"'le[ i"6 L+FRONT++!"'le[ L+FRONT++!"'le[ i"6 L+.AC++!"'le[ i"6 i"6 i"6 i"6
R+.AC+0+PREV!"'le[ R+FRONT+0+PREV!"'le[ L+.AC+0+PREV!"'le[ L+FRONT+0+PREV!"'le[
i"6 L+FRONT+0+MA\!"'le [ i"6 L+FRONT+0+MIN!"'le <[ i"6 R+.AC+0+MA\!"'le [ i"6 R+.AC+0+MIN!"'le <[ 3"*i'"e# l"' 5$e9mi%$*[ %"*6 3"*i'"e# l"' *6e5.#S5ee# 00,,,[ 00,,,[ %"*6 3"*i'"e# l"' *6e5F#S5ee# /,,,[ %"*6 3"*i'"e# l"' 63$".#S5ee# 0-,,,[ %"*6 3"*i'"e# l"' 63$"F#S5ee# ,,,[ %"*6 3"*i'"e# l"' *6!llS5ee# /,,,,[ i"6 i"6 i"6 i"6
R+.AC+STALL9!$[ R+FRONT+STALL9!$[ L+.AC+STALL9!$[ L+FRONT+STALL9!$[
i"6 R+.AC+*6e5UP[ R+.AC+*6e5UP[ i"6 R+FRONT+*6e5UP[ R+FRONT+*6e5UP[ i"6 L+.AC+*6e5UP[ i"6 L+FRONT+*6e5UP[ L+FRONT+*6e5UP[ i"6 63$"Ri'&6VAR[ i"6 63$"Le86VAR[ i"6 *6!llVAR[ i"6 3l6$!*3"#SHITC[ 3l6$!*3"#SHITC[ i"6 $!"#mTURN[ i"6 CRIT9!$[ 3"*i'"e# l"' 5$e9milli*[ 9i# *e635() ] 5i"M#e(T$i'Pi"OUTPUT)[ 5i"M#e(E%Pi"INPUT)[ 5$e9milli* milli*()[ &ile(milli*() &ile(milli*() 5$e9milli* ,,,) ,,,) ] Ul6$!*3"#()[ ^ R+.AC+0!66!%&(//,/<-,)[ R+FRONT+0!66!%&(,/,)[ L+FRONT+0!66!%&(<,/,,)[ L+.AC+0!66!%&(<,,/,,)[ R+.AC+/!66!%&(1<,,/,,)[ R+FRONT+/!66!%&(-,//,,)[ L+FRONT+/!66!%&(1,,/1,)[ L+.AC+/!66!%&(0,/,,)[ R+.AC+!66!%&(0/,,/<,)[ R+FRONT+!66!%&(00,,/,,)[ L+FRONT+!66!%&(0,<,,/<,)[ L+.AC+!66!%&(,,/1,,)[ R+.AC+0+!"'le ,[ R+FRONT+0+!"'le R+FRONT+0+! "'le ,[
L+FRONT+0+!"'le L+FRONT+0+!"'le ,[ L+.AC+0+!"'le L+.AC+0+!"'le ,[ R+.AC+/+!"'le [ R+FRONT+/+!"'le R+FRONT+/+! "'le 0//[ L+FRONT+/+!"'le L+FRONT+/+!"'le [ L+.AC+/+!"'le L+.AC+/+!"'le 0//[ R+.AC++!"'le [ R+FRONT++!"'le R+FRONT++! "'le [ L+FRONT++!"'le L+FRONT++!"'le [ L+.AC++!"'le L+.AC++!"'le [ R+.AC+0$i6e(R+.AC+0+!"'le)[ R+FRONT+0$i6e(R+FRONT+0+!"'le)[ L+FRONT+0$i6e(L+FRONT+0+!"'le)[ L+.AC+0$i6e(L+.AC+0+!"'le)[ R+.AC+/$i6e(R+.AC+/+!"'le)[ R+FRONT+/$i6e(R+FRONT+/+!"'le)[ L+FRONT+/$i6e(L+FRONT+/+!"'le)[ L+.AC+/$i6e(L+.AC+/+!"'le)[ R+.AC+$i6e(R+.AC++!"'le)[ R+FRONT+$i6e(R+FRONT++!"'le)[ L+FRONT+$i6e(L+FRONT++!"'le)[ L+.AC+$i6e(L+.AC++!"'le)[ 5$e9milli* milli*()[ &ile(milli*() &ile(milli*() 5$e9milli* /,,,) /,,,) ] Ul6$!*3"#()[ ^ ^ 9i# l5() ] $!"#mTURN $!"#m(0<)[ $!"#m(0<)[ i8(#i*6!"%e MIN#i*6!"%e) ] 3l6$!*3"#SHITC 3l6$!*3"#SHITC ,[ !l_FHD()[ &ile((R+.AC+0+!"'le &ile((R+.AC+0+!"'le `` L+.AC+0+!"'le L+.AC+0+!"'le ) aa aa 3l6$!*3"#SHITC 3l6$!*3"#SHITC ,) ] Ul6$!*3"#()[ ^ ^ el*e i8(#i*6!"%e MIN#i*6!"%e aa #i*6!"%e CRIT#i*6!"%e) ] $e*e6PREV!"'le()[ 3l6$!*3"#SHITC 3l6$!*3"#SHITC 0[ *6!llVAR ,[ 63$"Ri'&6VAR 63$"Ri'&6 VAR ,[ 63$"Le86VAR 63$"Le86VAR ,[ $6!6e()[ ^ el*e i8(#i*6!"%e CRIT#i*6!"%e) ] CRIT9!$ 0[ *i6%&(CRIT9!$) *i6%&(CRIT9!$) ] %!*e 0 : $e*e6PREV!"'le()[ 5$e9milli* milli*()[ &ile(milli*() &ile(milli*() 5$e9milli* ,,,) ] !l_.HD()[ CRIT9!$ /[ ^ %!*e / : $e*e6PREV!"'le()[ 3l6$!*3"#SHITC 3l6$!*3"#SHITC 0[ *6!llVAR ,[ 63$"Ri'&6VAR 63$"Ri'& 6VAR ,[ 63$"Le86VAR 63$"Le8 6VAR ,[
$6!6e()[ ;$e!_[
^
^ ^ 9i# !l_FHD() ] Ri'&6.!%_FHD()[ Ri'&6F$"6FHD()[ Le86.!%_FHD()[ Le86F$"6FHD()[ ^ 9i# !l_.HD() ] Le86F$"6.HD()[ Le86.!%_.HD()[ Ri'&6F$"6.HD()[ Ri'&6.!%_.HD()[ ^ 9i# 63$"LEFT() ] Ri'&6.!%_TRNL()[ Ri'&6F$"6TRNL()[ Le86F$"6TRNL()[ Le86.!%_TRNL()[ ^ 9i# 63$"RIGT() ] Le86.!%_TRNR()[ Le86F$"6TRNR()[ Ri'&6F$"6TRNR()[ Ri'&6.!%_TRNR()[ ^
/ SENSOR SENSOR ULT ULTRASbNI RASbNICO CO CSR, CSR,< < El *e"*$ #e 3l6$!*"i#* *e e"m!$%! #e"6$ #e l* *e"*$e* 5!$! me#i$ #i*6!"%i!* *35e$!$ ;*6>%3l* e"6$e 6$!* 5*i;le* 83"%i"e* E" e*6e %!* 9!m* ! 36iliB!$l 5!$! l! me#i%i7" #e #i*6!"%i!* E*6 l %"*i'3e e"9i!"# 3" 3l6$!*"i# (i"!3#i;le 5!$! el # &3m!" 5$ *3 !l6! 8$e%3e"%i!) ! 6$!9 6$!9@* @* #e 3" 3" #e l! 5!$e 5!$e=! =! #e %ili %ili"# "#$ $** 3e 3e %m5 %m5" "e e el *e"* *e"*$ $ (3" (3" 6$!"*#3%6$) y e*5e$! ! 3e #i%& *"i# $e;6e *;$e 3" ;=e6 y 93el9! $e6$" %!56!# 5$ el 6$ %ili"#$ E*6e *e"*$ e" %"%$e6 6ie"e 3" $!"' #e #i*6!"%i!* *e"*i;le e"6$e %m y m %" 3"! 5$e%i*i7" #e mm
cC7m 9!m* ! 6$!#3%i$ #i%& 6iem5 e" #i*6!"%i!d A5$9e%&!"# 3e l! 9el%i#!# #e #i%& 3l6$!*"i# e" el !i$e e* #e 9!l$ <, m* m* ,, ,< %mmi mmi%$ %$* *e' e' (y! (y! 3e 6$!; 6$!;! !=!$e =!$em m** %" %" %e"6 %e"6m me6 e6$ $** y mi%$*e'3"#*) P!$! %!l%3l!$ l! #i*6!"%i! $e%$#!$em* 3e 9#6 (#e8i"i%i7" #e 9el%i#!#: #i*6!"%i! $e%$$i#! e" 3" #e6e$mi"!# 6iem5) De l! 87$m3l! !"6e$i$ #e*5e=!m* # ;6e"ie"# #96 *ie"# 9 l! %"*6!"6e !"6e$i$me"6e %i6!#! y 6 el 9!l$ #e93el6 5$ el *e"*$ ! l! 5l!%! A$#3i" T!m;i@" !m;i@" &!;$> 3e #i9i#i$ el $e*3l6!# e"6$e / #!# 3e el 6iem5 $e%i;i# e* el 6iem5 #e i#! y 93el6!
El *e"*$ %"*6! #e < 5i"e*: fVCCf %"e%6!# ! l! *!li#! #e V #e l! 5l!%! fT$i fT$i'f 'f %"e %"e%6 %6!# !# !l 5i" 5i" #i'i #i'i6! 6!ll #e l! 5l!% 5l!%! ! e"%! e"%!$' $'!# !# #e e"9i e"9i!$ !$ el 53l* 53l* 3l6$!*7"i% fE%&f !l 5i" #e e"6$!#! #i'i6!l 3e $e%i;i$> el e% #e #i%& 53l* y fGNDf ! 6ie$$!
PROGRAMACION ULTRASONIDO g
9i# Ul6$!*3"#() ] i8 (T$i'V!l LOH aa mi%$*() T$i'Time$ T$i'Cy%le) ] T$i'V!l IG[ #i'i6!lH$i6e (T$i'Pi"T$i'V!l)[ T$i'Time$ mi%$*()[ mi%$*() [ ^ el*e i8 (T$i'V!l IG aa mi%$*() T$i'Time$ T$i'Si') ] T$i'V!l LOH[ #i'i6!lH$i6e (T$i'Pi"T$i'V!l)[ ^ el*e i8 (T$i'V!l LOH) ] E%I"6e$9!l 53l*eI"(E%Pi"IGT$i'Cy 53l*eI"(E%Pi"IGT$i'Cy%le)[ %le)[ i8 (E%I"6e$9!l (E%I"6e$9!l , aa E%I"6e$9!l M!E%) M!E%) ] #i*6!"%e m!5 (E%I"6e$9!l Mi"E% M!E% / <-,)[ 3l6$!*3"#SHITC 3l6$!*3"#SHITC 3l6$!*3"#SHITC 3l6$!*3"#SHITC K 0[ ^ el*e i8 (E%I"6e$9!l M!E%) ] #i*6!"%e <-,[ 3l6$!*3"#SHITC 3l6$!*3"#SHITC 3l6$!*3"#SHITC 3l6$!*3"#SHITC K 0[ ^ ^ ^
g ULTRASONIDO g
g RESETEO g
9i# $e*e6PREV!"'le() ] R+.AC+0+PREV!"'le R+.AC+0+P REV!"'le ,[ R+FRONT+0+PREV!"'le R+FRONT+0+P REV!"'le ,[ L+.AC+0+PREV!"'le L+.AC+0+ PREV!"'le ,[ L+FRONT+0+PREV!"'le L+FRONT+0+ PREV!"'le ,[ ^
CA.LES M!%& &em;$!
< CASIS
ARDU ARDUIN INO O NANO NANO
De*%$i5%i7" El A$#3i" N!" e* 3"! 5e3e2! y %m5le6! 5l!%! ;!*!#! e" el ATme'!/ (A$#3i" N!" ,) el ATme'!01 ATme'!01 e" *3* 9e$*i"e* !"6e$i$e* (A$#3i" N!" /) 3e *e 3*! %"e%6>"#l! ! 3"! 5$6;!$# Tie"e m>* me"* l! mi*m! 83"% 83"%i i"! "!li# li#!# !# 3e 3e el A$#3i $#3i" " D3em D3emilil!" !"9 9e e 5e$ 5e$ %" %" 3"! 3"! 5$e* 5$e*e" e"6! 6!%i %i7" 7" #i8e$e"6e N 5*ee %"e%6$ 5!$! !lime"6!%i7" e6e$"! y 83"%i"! %" 3" %!;le US. Mi"i. C!$!%6e$*6i%!* • • • • • • •
• • • •
Mi%$%"6$l!#$: A6mel ATme'!/ (ATme'!01 9e$*i"e* !"6e$i$e*) Te"*i7" #e O5e$!%i7" ("i9el l7'i%): V Te"*i7" #e E"6$!#! ($e%me"#!#): -0/ V Te"*i7" #e E"6$!#! (lmi6e*): 1/, V Pi"e* ES Di'i6!le*: 0< (#e l* %3!le* 1 5$9ee" #e *!li#! PHM E"6$!#!* A"!l7'i%!*: A"!l7'i%!*: C$$ie"6e m> 5$ %!#! PIN #e ES: <, mA Mem$i! Fl!*&: / . (ATme'!/) #e l* %3!le* /. *" 3*!#* 5$ el ;6l!#e$ (01 . ATme'!01) SRAM: / . (ATme'!/) (0 . ATme'!01) EEPROM: 0 . (ATme'!/) (0/ ;y6e* ATme'!01) F$e%3e"%i! #e $el=: 01 MB Dime"*i"e*: 0mm </mm
E"e$'! El A$#3i" N!" 5*ee *ele%%i7" !36m>6i%! #e l! 83e"6e #e !lime"6!%i7" y 53e#e *e$ !lime"6!# ! 6$!9@* #e: • • •
U"! %"ei7" Mi"i. US. U"! 83e"6e #e !lime"6!%i7" " $e'3l!#! #e 1/,V (5i" ,) U"! 83e"6e #e !lime"6!%i7" $e'3l!#! #e V (5i" /-)
Al !lime"6!$ el !$#3i" ! 6$!9@* #el Mi"i US. el FTDI FT//RL 5$5$%i"! 3"! *!li#! #e V e" el 5i" 01 #e l! 5l!%! P$ e"#e %3!"# *e %"e%6! ! 3"! 83e"6e e6e$"! (" US.) l* V " *e e"%3e"6$!" #i*5"i;le*
Di!'$!m! #e Pi"e* 1 TARJETA TARJETA DE E\PANSIbN E\PANSIbN PARA PARA EL ARDUINO NANO NANO M7#3l #e e5!"*i7" !$#3i" "!" %m5!6i;le %" !$#3i" N!" 9/ y V " 6ie"e l! "e%e*i#!# #e 3*!$ "i"'4" 6i5 #e %!;le e6e$" E*6! ;!$# 5e$mi6e l! %"ei7" #e 9!$i* m7#3l* e6e$"* %m *e"*$e* *e$9m6$e* $el@* i"6e$$356$e* 56e"%i7me6$* e"6$e 6$* E*6e m7#3l 5e$mi6e 8!%ili6!$ el 3* e"6$e l! ;!$# !$#3i" y %3!l3ie$ 6$ &!$#!$e E" e*e"%i! *e 5#$! #e%i$
3e e*6! ;!$# *e e"%!$'! #e e5!"#i$ l! 83"%i"!li#!# #e %3!l3ie$ 5l!%! !$#3i" 'e"e$!"# 3" m!y$ $#e" e" l! %i$%3i6e$! CARACTERISTICAS A$#3i" N!" !"# 9
Cm5!6i;ili#!# Pi"e* #e e"6$!#!*!li#! (VCCGNDSIGNAL)
6i5
*e$9m6$ 0<
Pi"e* !"!l7'i%*
Pi"e* PHM
1
Pi"e* #e !lime"6!%i7" (*e$9)
0
Pi"e* #e e5!"*i7" I/C
S!li#!
AREF
Vl6!=e #e *!li#!
V
T!m!2
%m %m %m
Pe*
/,, '$!m*
9/
- ARMADO L *i'3ie"6e #e;em* #e 6e"e$ 6#* *3* m!6e$i!le* 0 !$m! !$m!$$ el el %&! %&!*i *i* * / %l %l%! %!$$ l* l* 6$"i 6$"illll* * %l %l%! %!$$ l* l* *e$9 *e$9* * < i"*6 i"*6!l !l!$ !$ %$$e %$$e%6 %6!m !me" e"6e 6e l!* i"*6 i"*6!l !l!% !%i i"e "e** #e l* %!;l %!;le* e* #e l* *e$9* 3;i%!$l* ;ie" I"*6!l I"*6!l!$l !$l el *e"*$ *e"*$ 3l6$!* 3l6$!*7"i 7"i% % !l! 8$e"6e$ 8$e"6e$ #el m79il e" e*6e e*6e %!* !$!2! 1 Cl%!$ Cl%!$ el !$#3i" !$#3i" %" %" l! 6!$=e6 6!$=e6! ! #e e5!" e5!"*i7" *i7" - C"e%6 C"e%6!$ !$ l* %!;le* %!;le* ! %!#! 5i" #el #el *e$9m6 *e$9m6$ $ %" l! 6!$=e6! 6!$=e6! #e e5!"*i7" Cl% l%! !$ l* l* %!; %!;le* le* #e *e"* e"*$ 3l6$! l6$!**7"i% 7"i% %" %" l! 6!$= 6!$=e6 e6! ! #e e5!"*i7" i"#i%!"# %!#! 5i"e*
