UNIVERSIDAD DEL QUINDIO, INGENIERÍA ELECTRÓNICA, PROYECTO FINAL DE ROBÓTICA MÓVIL, PRESENTADO DURANTE EL SEGUNDO PERIODO DEL AÑO 2012
1
9&-7( L#$' En-/#(6 G&n6l(6, 9$- Al(=n%-& A-$'"$6)l, Al(=n%- B(=-n& R$n!4n
R&)&" !&n"-&l%& &- +4%#l& TRF:2.;G Resumen —Aquí se presentará presentará la construcción construcción de un carro arro Robot obot con control trolad ado o por por una int interfaz de comput computador ador desarrol desarrollada lada en Matlab Matlab y comuni comunicad cado o inalámbricamente por un enlace de radio Half-Duplex radio Half-Duplex dado por los módulos TRF-2!" #$% Abstract— &ere &ere 'e prese present nt t(e t(e constr construct uction ion of a robot carria)e carria)e controlled controlled by a compute computerr interf interface ace de*eloped in Matlab and communicated 'irelessly by a radio lin+ )i*en &alf-,uple TRF-2!" modules#$% inalámbrico. inalámbrico. Palabras claves —Robot. comunicación. pro)ramación Keywords— Robot. 'ireless. communication. pro)rammin)
interfaz. interfaz.
interface.
I. I NTRODUCCIÓN
E n l !"#l$%% l&' (nl!(' !)l(%&' *n '$%& !+)$%&' &- (nl!(' (nl!(' $nl+)-$!&', /#( '&n +# $+&-"n"(' $+&-"n"(' (n (l %('--&ll& %( l' !&+#n$!!$&n(' '&n $n!&-&-%&' (n +#!*&' %$'&'$"$&' #'%&' (n l $% !&"$%$n !&+& !(l# !(l#l l-( -(', ', "(!l "(!l% %&' &',, !&n" !&n"-& -&l( l(', ', ("!, ("!,33 n& n&'' ($" ($"n n l$+$"!$&n(' %( %$'"n!$. E'"&' (nl!(' $nl+)-$!&' '&n #'%&' (n ('"( -&(!"& - %-l( 4-%(n(' 4-%(n(' %( +&$+ +&$+$(n" $(n"&& #n R&)&" #'n%& #n $n"(-56 -(l$6% (n M"l) /#( !#(n" !&n 5#n!$&n(' !&+& !&+& %(ln %(ln"( "(,, "-', "-', %(-( %(-(!* !* 4 $6/# $6/#$( $(-% -%.. P&- "n"& "n"& !#n%& l78n !&+n%& (n l $n"(-56 '( &-$+$%& (l R&)&" '( +&(- *!$ %$!*& l#7-.
M4%#l&' M4%#l&' TRF:2.;G@6 P#(n"( @ R('$'"(n!$' P-&"&)&-% C)l( USB C&n(-'&- RS22:USB S&5"-( AVR:S"#%$& S&5"-( M"l) IV. IV. MARCO MARCO TEÓR TEÓRICO ICO
•
Interfaz: Un
$n"(-56 7-5$! %( #'#-$& & GUI G-*$!l U'(- In"(-5!(3 (' #n +(%$& &- (l !#l '( !&+#n$! (l #'#-$& !&n (l %$'&'$"$&. A#n/#( "+)$n (' &'$)l( *!(-l& &- ln(' %( !&+n%&. N& (' #n +"&%& "n $n"#$"$& !&+& l GUI, GU I, /#( /#( ('" ('" '( !&+ !&+&n( &n( %( 7-5 7-5$! $!&' &',, )&"&n(', )&"&n(', )--' %( %('l6+$(n %('l6+$(n"&', "&', (n"-( &"-' *(-- (--+ +$(n"'. '. Q#( (-+ (-+$"(n l #'# #'#-$ -$&& !&+-(n !&+-(n%(%(- %( #n +n(- +n(- +' '(n!$ll '(n!$ll l&' !&+n%&' n(!('-$&' - %- #n !&--(!"& #'& l %$'&'$"$&.
V. ESPECIFICACIONES DEL SISTEMA a) Hard Hardwa ware re del del sis siste tema ma::
L l" l"5&5&-+ + #'% #'% - - ('"( ('"( -&(!"& -&(!"& !&+& '( &)'(- (n l F$7.1 !#(n" !&n !#"-& -#(%' (n !&n5$7#-!$4n %$5(-(n!$l, %&n%( !% -#(% !#(n" !&n #n +&"&- DC.
Robot móvil:
II. OB9ETIVOS ►
►
C&n'"-#$- #n R&)&" !&+#n$!%& !&+#n$!%& $nl+)-$!+(n"( $nl+)-$!+(n"( #'n%& (l +4%#l& TRF:2.;G. D('D('--&l -&lll- #n $n"($n"(-56 56 (n (l !&+# !&+#"% "%&&- !&n !&+n% !&+n%&' &' %( +&$+ +&$+$( $(n"& n"& - (n (n$$- 4-%(n( 4-%(n('' l R&)&" !&n'"-#$%&. III. MATERIALES
P- (l %('--&ll& %( l -!"$! (' n(!('-$& "(n(- l& '$7#$(n"(<
Pl"5&-+ +4$l T-=(" %( %('--&ll& >AT+(7 1?
F$7.1 Pl"5&-+ +4$l #'% - (l -&(!"& -&(!"&
UNIVERSIDAD DEL QUINDIO, INGENIERÍA ELECTRÓNICA, PROYECTO FINAL DE ROBÓTICA MÓVIL, PRESENTADO DURANTE EL SEGUNDO PERIODO DEL AÑO 2012
E' #n +4%#l& "-n'!("&- %( -%$& 5)-$!%& &- Laia! Te!"nolo#$ 2H /#( "-)= (n l )n% %( 5-(!#(n!$ %( 2.; G*6. E'"( (/#(& %$'&'$"$& +&'"-%& (n l F$7.2 "$(n( $n"(7-%& #n +&%#l%&-, #n +l$5$!%& #n n"(n (' l$+(n"%& !&n .J &l"$&'.
2
TRF-2.4G<
F$7.; C&n5$7#-!$4n %( $n(' %(l *+ente H L2, E' #n "-=(" %( %('--&ll& - l$!!$&n(' (+)()$%' )'% (n (l M$!-&!&n"-&l%&AT+(71? ?H !# !&n5$7#-!$4n %( $n(' (' +&'"-% (n l F$7.J3, l !#l !#(n" !&n #n &"(n!$4+("-& - -$!$4n %( l (n"-% nl&73 $n"(--#"&-(', L(%', (n"-( &"-&' #n !&n(K$4n USB !&n (l !&+#"%&- - %('!-7- l&' !4%$7&' $+l(+(n"%&' #'n%& (l HI3 oot Flas" H
Tar/eta de desarrollo - 0Tme#a 1:
F$7.2 M4%#l& TRF:2.;G E'"( +4%#l& 5#( '$"#%& '&)-( #n l"5&-+ %$'(% - %(!#- l&' $n(' #n -&"&)&-%, !&+(-!$l$6% &- %i#ma &le!troni!a H /#( '( #(%( &)'(-- (n l F$7. !&n (l n&+)-( %( l&' $n(' -('l"%&. A%(+' - l !&n5$7#-!$4n %( ('"( +4%#l& '( #'4 (l D"'*((" -&&-!$&n%& &- %i#ma &le!troni!a (l %&!#+(n"& ll+%& 'emoria (4.
F$7.J C&n5$7#-!$4n %( $n(' %(l M$!-&!&n"-&l%&- AT+(71? b) %oftware de Interfaz:
O5-(!( #n *(--+$(n" ll+% GUIDE G5I 3eveloment &nvironment 3 l !#l (-+$"( 7(n(-- #n $n"(-56 7-5$! %( #n +n(- -$% '(n!$ll. D$!* GUI '( !&+&n( %( %&' (l(+(n"&'. Un& (' l -"( 7-5$! /#( (- (l #'#-$& l &"- (' #n s!rit (n (l !#l ('"-n "&%&' l&' !allba!6s /#( '&n ll+%&' l 7(n(--'( #n ((n"&, &- (=(+l& l -('$&n- #n )&"4n.
'atlab:
F$7. Pl"5&-+ - (l M4%#l& TRF:2.;G E' #n !$-!#$"& $n"(7-%& #'%& - (l !&n"-&l %( (l&!$%% %( +&"&-(' DC "$(n( #n !&n5$7#-!$4n %( $n(' !&+& '( +#('"- (n l F$7.; JH
*+ente H-L2,:
UNIVERSIDAD DEL QUINDIO, INGENIERÍA ELECTRÓNICA, PROYECTO FINAL DE ROBÓTICA MÓVIL, PRESENTADO DURANTE EL SEGUNDO PERIODO DEL AÑO 2012 o
&taa de ad8+isi!ión !om+tador
de
datos
!on
el
E'"' ("' '&n %('!-$"' !&n"$n#!$4n< En ('" 5'( %(l -&(!"& '( -(l$64 l !&+#n$!!$4n (n"-( l&' +4%#l&' TRF:2.; !&n(!"%&' l' "-=("' %( %('--&ll& l$+(n"%&' !&n .J &l"$&'. D( ('"( +&%& (l %"& (n$%& l -(!("&- (' #n %"& )$n-$& -&&-!$&n%& &- l !"$!$4n %( &!*& $n"(--#"&-('.
o &taa
F$7.? V(n"n %( $n$!$& GUIDE MATLAB GUIDE (' #n *(--+$(n" %( 5!$l #'&, /#( - !-(- #n n#( $n"(-56 '4l& '( !-( #n n#( GUI (n )ln!&. En l (n"n %( %('--&ll& '( (n!#(n"-n "&%&' l&' (l(+(n"&' n(!('-$&' - '# !&n'"-#!!$4n. P- $n"(7--l&' l $n"(-56 '&l& (' n(!('-$& --'"--l&'.
de !om+ni!a!ión inal7mbri!a:
P- (l 5#n!$&n+$(n"& %( l&' +4%#l&' '( #'4 l l$)-(- TRF2;@, (n l !#l *)n -#"$n' %( $n$!$l$6!$4n, !&n5$7#-!$4n, (n$4 -(!(!$4n. Un (=(+l& %(l #'& %( ('" l$)-(- - l "-n'+$'$4n %( #n %"& %( )$"' (' -('(n"%& &'"(-$&-+(n"(< /* CODIGO PARA EMITIR DATOS TX */ #include
F$7. En"&-n& %( %('--&ll& (n GUIDE Un (6 !&n'"-#$% l $n"(-56, '( -('$&n (l )&"4n !&--(- ('" #"&+"$!+(n"( !-(- #n '!-$" !&n l&' !allba!6s n(!('-$&' - !% ((n"&. A ('"&' !allba!6s '( l(' #(%( 7-(7- ln(' %( !4%$7& & *!(- (l ll+%& #n 5#n!$4n. Un (6 7-(7%' l' 5#n!$&n(' - !% ((n"&, l GUI /#(% l$'" - '# #'&. VI. PROCEDIMIENTO P- ll(- !)& ('"( -&(!"& '( (=(!#"-&n l' '$7#$(n"(' ("'< o o
&taa de !om+ni!a!ión inal7mbri!a &taa de ensamble !on la lataforma
in!78! da!o9TR4'(G8TAM8PA:OAD;DATOS9TR4'(G8TAM8 PA:O AD;5//9TR4'(G8TAM8P A:OA D;2 -='>(?5 in!78! i2=5 da!o93;236@@5 da!o9=;236AA5 da!o9';236@@5 da!o9>;236AA5 /*IICIO : CO 4IG1R ACIO DE M OD1 O TR4'.(G*/ !r&'()8iniciar+,5 hile+=, !r&'()8recon&i)urar+TR4'(G8CAATR4'(G8TX,5 !r&'()8recon&i)urar+TR4'(G8CAATR4'(G8TX,5 !r&'()8recon&i)urar+TR4'(G8CAATR4'(G8TX,5 !r&'()8recon&i)urar+TR4'(G8CAATR4'(G8TX,5 /*Se envBan lo$ da!o$ or radio*/ !r&'()8enviar+da!o,5 PORTA2da!o93;5 8dela"8$+=333,5 ? re!urn 35 ?
UNIVERSIDAD DEL QUINDIO, INGENIERÍA ELECTRÓNICA, PROYECTO FINAL DE ROBÓTICA MÓVIL, PRESENTADO DURANTE EL SEGUNDO PERIODO DEL AÑO 2012
En (l !4%$7& n"(-$&- '( #(%( -('l"- (l *(!*& %( /#( '( #'( l 5#n!$4n re!onfi#+rar -$' (!(', /#( '$ n& '( -(l$6 (l -&!('& n& 5#n!$&n (l +4%#l&. o
;
C&+& '( (Kl$!4 n"(-$&-+(n"( '( #"$l$64 l *(--+$(n" G+ide %( '0TL0 - 7(n(-- #n $n"(-56 7-5$! %( #'#-$& l !#l (' +&'"-% (n l F$7..
&taa de ensamble !on la lataforma
En ('" (" '( -(l$64 l !&n(K$4n %(l +4%#l& -(!("&- l l"5&-+ +4$l !&+& '( ( (n l F$7.. A' (l #(n"( @ /#( +n(= l&' +&"&-(' 5#( !&n"-&l%& !&n l&' %"&' -(!$)$%&' &- (l M$!-&!&n"-&l%&- E'"( #(n"( @ (' l$+(n"%& !&n #n 5#(n"( (K"(-n %( .J &l"$&'.
F$7. In"(-56 %( #'#-$& 7(n(-% Un (6 7(n(-% '( $+l(+(n"4 #n -&"&!&l& %( !&+#n$!!$4n (n"-( (l !&+#"%&- (l M$!-&!&n"-&l%&/#( (n l&' %"&' l "-n'+$'&- TRF:2.;G@6. El -&"&!&l& '( !&+&n( %( #n B"( %( $n$!$& %( "-n'+$'$4n, #n )"( %( 5#n!$4n, #n "-+ %( 2 B"(' #n B"( %( 5$nl$6- l "-n'+$'$4n.
F$7. M&n"=( %(l +4%#l& %( !&+#n$!!$4n !&n l"5&-+ +4$l >R(!("&- "-n'+$'&- L -#() -(l$6% 5#( (n$- %"&' )$n-$&' 7(n(-%&' &- l !"$!$4n %( l&' $n"(--#"&-(' /#( &'(( l "-=(" %( %('--&ll& l -(!("&- !&n(!"%& l l"5&-+ %( ('" +n(- (l R&)&" -(l$6 +&$+$(n"&' *!$ l %(-(!*, $6/#$(-%, %(ln"(, "-' 4 '( /#(% /#$("&. o
&taa de ad8+isi!ión !om+tador:
de
datos
!on
el
F$7. P-&"&!&l& %( !&+#n$!!$4n L 5#n!$4n "-n'+$"$- #' '#)'#n!$&n(' ('")l(!$%' &MATLAB - l !&+#n$!!$4n &- +(%$& %( #n #(-"& 5'$!& %( RS22 !&n (l M$!-&!&n"-&l%&-. P- ('" !&+#n$!!$4n '( #"$l$64 l "-=(" FT22 +&'"-% (n l F$7.10, /#( (-+$"( "-' %( #n #(-"& USB "(n(- #n 'l$% %( RS22.
UNIVERSIDAD DEL QUINDIO, INGENIERÍA ELECTRÓNICA, PROYECTO FINAL DE ROBÓTICA MÓVIL, PRESENTADO DURANTE EL SEGUNDO PERIODO DEL AÑO 2012
J
F$7.10 T-=(" FT22 > C&n(-'&- RS22 : USB L 5#n!$4n "-n'+$"$-, #"$l$6 l' '#) 5#n!$&n(' %( MATLAB serial9) foen9) f!lose9) fwrite9) fread9) l' !#l(' '$-(n - !-(- #n #(-"& %( !&+#n$!!$4n, )-$- (l #(-"&, !(--- (l #(-"&, ('!-$)$- (n (l #(-"& l((- %(l #(-"& -('(!"$+(n"(. E'" 5#n!$4n '&l& (n #n "-+ %( %"&' l M$!-&!&n"-&l%&-, %( * '( (n l "-+ &- SPI l "-n'+$'&- TRF2.;G@6 ('" '( !&+#n$! %( 5&-+ $nl+)-$! !&n (l R&)&" $n%$!n%&l( *!$ %&n%( %()( $-. 5#n!"$&n T-n'+$"$-START,FUNCION,DATOL,DATO@,STOP3 INSTRFIND 5!l&'(3 '1 '(-$l !&+,B#%R"(,?00,P-$",n&n(,S"&)$"',13 5&(n'13 5-$"('1,START, #$n"3STRART:0K0J #'(0.013 5-$"('1,FUNCION, #$n"3FUNCION #'(0.013 5-$"('1,DATOL, #$n"3DATOL #'(0.013 5-$"('1,DATO@, #$n"3DATO@ #'(0.013 5-$"('1,STOP, #$n"3STOP 0K0 #'(0.013 5!l&'('13 (n%
En '(7#$% '( +#('"- #n !"#- %( l !&n(K$4n -(l$6% (n"-( (l +4%#l& "-n'+$'&- (l !&+#"%&- /#( '( #'4 - -(l$6- (l -&(!"&.
F$7.11 C&n(K$4n -(l$6% %(l +4%#l& "-n'+$'&- l !&+#"%&- VII. CONCLUSIONES El +n(=& %( l&' +4%#l&' $nl+)-$!&' TRF2.;G (' +# 8"$l - +#!*' l$!!$&n(', &-/#( (-+$"( +n%%"&' %$'"n!$' -(l"$+(n"( 7-n%(' n& '( ( $n"(-5(-$%& &- &)'"!#l&', "&%& ('"& #'n%& +# )= &"(n!$. S( &)'(-4 /#( (l &l"=( +n(=%& - l&' +&"&-(' (' )=&, /#( (l R&)&" '( ( ('5&-6%& !#n%& -(l$6 +&$+$(n"&' *!$ l $6/#$(-% & *!$ l %(-(!*. L $n"(-56 7-5$! %( #'#-$& (-+$"( /#( #n #'#-$& '$n !&n&!$+$(n"& l7#n& %(l %$'&'$"$& #(% $n"#$- !#l(' '&n l&' !&+n%&' /#( #(%( (=(!#"- (l %$'&'$"$& ' !&n"-&l-l&. VIII. REFERENCIAS 1H ;'ód+lo TRF2.4G< R(!#(-%& (l 1J S("$(+)-( %( 2012, *""<'"&-(./$"'.!&++&-($n5&.!5+"K-K2;7.%5
%( %(
UNIVERSIDAD DEL QUINDIO, INGENIERÍA ELECTRÓNICA, PROYECTO FINAL DE ROBÓTICA MÓVIL, PRESENTADO DURANTE EL SEGUNDO PERIODO DEL AÑO 2012
2H ;Laia! Te!"nolo#$< R(!#(-%& (l 12 %( N&$(+)-( %( 2012, %( *""<.l$!.!&+ H ;%i#ma &le!troni!a< R(!#(-%& (l 2 %( O!"#)-( %( 2012, %( *""<.'$7+(l(!"-&n$!.n(" ;H M&-l(' G. Wn7(l G. ;'emoria<. 2==. R(!#(-%& (l ; %( S("$(+)-( %( 2012, %( *""<.$$".#!&+$ll'.('5!-('#+(n(';;? ?%?1.%5 JH ;3atas"eet de H-L2,< Re!+erado el 2= de setiembre
de
2=12
de
*""<%5%".%"'*(("'$"(.!&+%51STL2P.%5
?H ;3atas"eet 0Tme#a 1< R(!#(-%& (l 1J %( S("$(+)-( %( 2012, %( *""<."+(l.!&+I+7('%&!2;??.%5 H %oftware HI3 oot Flas" R(!#(-%& (l 22 %( S("$(+)-( %( 2012, %( *""<.&)%(."-&%#!"'#'))&&"l&%*$%.*"+l IX. AUTORES /or)e 0uis 1nríquez "onzález
N!$4 (n P'"&, N-$& (l 0 %( )-$l %( 11, ('"#%$& l -$+-$ (n (l !&l(7$& N#('"- '(&- %( B(ln, C#l+$n& (l )!*$ll(-"& (n (l !&l(7$& CASD !"#l+(n"( !#-' &!"& '(+('"-( %( $n7(n$(- (l(!"-4n$! (n l Un$(-'$%% %(l Q#$n%& (-"(n(!( l 7-#& %( $n('"$7!$4n GITUQ %(l -( %( "(l(!&+#n$!!$&n(' %( l #n$(-'$%% %(l Q#$n%&. Aleandra 3earano Rincón
N!$4 (n Cl-!, Q#$n%& (l %( =#n$& %( 11, ('"#%$& l -$+-$ (n (l !&l(7$& R5(l U-$)( U-$)( %( Cl-!, C#l+$n& (l )!*$ll(-"& (n (l !&l(7$& Sn 9&' %( Cl-! !"#l+(n"( !#-' '"$+& '(+('"-( %( $n7(n$(- (l(!"-4n$! (n l Un$(-'$%% %(l Q#$n%& (-"(n(!( l 7-#& %( $n('"$7!$4n GAMA %(l -( %( !&n"-&l #"&+"$6!$4n %( l #n$(-'$%% %(l Q#$n%&. /air Aleandro Aristizabal
N!$4 (n A-+(n$, Q#$n%& (l 2 %( +& %( 1, ('"#%$& l -$+-$ (n (l L(4n %( G-($55 %( Cl-!, C#l+$n& (l )!*$ll(-"& (n (l !&l(7$& 9&-7( I'!' %( A-+(n$ !"#l+(n"( !#-' n&(n& '(+('"-( %( $n7(n$(- (l(!"-4n$! (n l Un$(-'$%% %(l Q#$n%&.
?