Difference between revisions of "Pohyb robota po čiare a zaznamenávanie vzdialenosti okolitých objektov (Dudík, Kemény)"

From RoboWiki
Jump to: navigation, search
(New page: == Pohyb robota po čiare a zaznamenávanie vzdialenosti okolitých objektov == '''Úvod''' Našou úlohou bolo naprogramovať Acrob robota tak aby sa hýbal smerom dopredu sledovaním ...)
 
m
 
(39 intermediate revisions by the same user not shown)
Line 1: Line 1:
−
== Pohyb robota po čiare a zaznamenávanie vzdialenosti okolitých objektov ==
+
===Úvod===
  
 +
Našou úlohou bolo naprogramovať Acrob robota tak aby sa hýbal smerom dopredu sledovaním čiary a popritom meral vzdialenosti okolitých objektov. Na sledovanie čiary sme použili dva svetelné čiarové senzory. Na zisťovanie vzdialenosti okolitých objektov sme použili IR senzor. Použili sme iba jeden senzor umiestnený na ľavom boku robota.
 +
 +
===Zapojenie===
 +
 +
[[Image: svetelne_senzory_popisky.png]]
 +
 +
[[Image: ir_senzor_popisky.png]]
  
−
'''Úvod'''
+
[[Image: zapajanie_popisky.png]]
  
−
Našou úlohou bolo naprogramovať Acrob robota tak aby sa hýbal smerom dopredu sledovaním čiary a popritom meral vzdialenosti okolitých objektov. Na sledovanie čiary sme použili dva svetelné čiarové senzory. Na zisťovanie vzdialenosti okolitých objektov sme použili IR senzor. Použili sme iba jeden senzor umiestnený na ľavom boku robota.
+
===Opis aplikácie===
 +
 
 +
Aplikácia sa delí na dve logické časti. V prvej sa vykoná takzvaný SETUP robota, kde sa inicializujú jeho vnútorné premenné. V druhej časti sme definovali samotnú funkcionalitu robota. Základné funkcie, ktoré robot vykonáva sú sledovanie čiary a mapovanie okolitého prostredia.  
 +
 
 +
<u>Sledovanie čiary</u>
 +
 
 +
Aplikácia spracováva dáta, ktoré mu boli sprostredkované pomocou čiarových senzorov na podvozku robota. Tieto hodnoty si uchováva vo svojich vnútorných premenných a ďalej ich spracováva.  Ak sa čiarový senzor nachádza nad tmavým povrchom, reprezentovaným vodiacou čiarou, nasnímané hodnoty sú vysoké. Ak sa sníma bieli povrch na ktorom sa robot pohybuje, tak sú nasnímané hodnoty veľmi nízke. Vďaka týmto veľkým rozdielom sme schopný detegovať jeho pozíciu. Pohyb robota prebieham týmto spôsobom. Ak sa nasnímali nízke hodnoty na pravom senzore aj ľavom tak sa robot pohybuje rovno. Vodiaca čiara sa nachádza medzi senzormi. Ak robot deteguje, že jeden senzor zaznamenal rapídny nárast hodnoty, aplikácia upraví pohyb robota tak aby sa vrátil do pôvodnej dráhy a dostal vodiacu čiaru medzi čiarové senzory.  
 +
 
 +
<u>Mapovanie prostredia</u>
 +
 
 +
Mapovanie prebieha za behu robota. Aplikácia vo vnútri robota vykonáva nie len snímanie povrchu ale zaznamenáva aj okolie robota. Okolie je snímané pomocou IR senzora. Jeho výstupy sú spracované špeciálne navrhnutými algoritmami na mapovanie. Algoritmus spracováva vzdialenosť okolitých objektov, ktoré boli zaznamenané ako tok znakov reprezentujúcich vzdialenosti. Pre jednoduchšie spracovanie a následnú vizualizáciu dát sme tieto namerané dáta predelili konštantou.  
 +
 
 +
 
 +
===Zdrojový kód===
 +
 
 +
<u>Ukážka podmieneného smeru pohybu robota</u><br /><br />
 +
Situácia : Ľavý čiarový senzor narazil na vodiacu čiaru a je potrebné vykonať korekciu pohybu doľava.
 +
 
 +
<pre>
 +
if (val_senzor_l > 200) { 
 +
  Lavy_motor.write(90+SLOW);
 +
  Pravy_motor.write(90+SLOW);
 +
  delay(800);
 +
  Lavy_motor.write(90 - SLOW); 
 +
  Pravy_motor.write(90 + SLOW);
 +
  delay(500);
 +
}
 +
</pre>
 +
 
 +
<u>Ukážka procesu mapovania</u>
 +
 
 +
<pre>
 +
Skreslena_vzdialenost = val_infra_1 / 80;              //hodnotu senzora predelim konstantou ktora bola optimalizovana
 +
if (Skreslena_vzdialenost < 10) {                      //vdaka optimalizovanej konstante by hodnota nemala prekrocit desat
 +
  CelaMapa += String( 10 - Skreslena_vzdialenost, DEC); //zapisem nameranu hodnotu do stringu
 +
  CelaMapa += String( " ");                            //pridam medzeru za kazdou hodnotou
 +
}
 +
</pre>
 +
 
 +
zdrojový kód [[Media:Projekt_d_k.zip]]
 +
 
 +
===Výstup===
 +
 
 +
<br />
 +
 
 +
video mapovania [http://tinypic.com/r/fthc42/5]
 +
 
 +
<br />
  
−
'''Zapojenie'''
+
<u>Ukážka z výstupného textového okna programu Arduino</u>
  
−
                adc_vals[0] - ľavý senzor
+
[[Image: mapa_pomlcky.png]]
−
                adc_vals[1] - pravý senzor
 
  
−
Program po nadviazaní spojenia s počítačom pomocou bluetooth prostredníctvom programu putty reaguje na stlačenia kláves nasledovne:
+
<br />
−
  p - testovacie tlačidlo, vypíše do výstupu putty "hello"
 
−
  i - vypíše hodnoty z poľa adc_vals od 0 po 7
 
−
  w,s,a,d - ovládanie robota šípkami
 
−
  g - zastaví oba motory
 
−
  v - vypíše hodnoty senzorov na čiaru
 
−
  c - spustí sa nasledovanie čiary robotom
 
  
−
'''Algoritmus nasledovania čiary:'''
+
<u>Graf z výstupných hodnôt</u>
  
−
V cykle prechádza nasledovným vetvením:
+
[[Image: graf_mapa_prekazok.png]]
−
Ak vidí robot na oboch senzoroch svetlo ide rovno (predpokladá, že čiaru má medzi senzormi).
 
−
Ak vidí na ľavom otočí sa na mieste do ľava, kým nevidí znova na oboch svetlo.
 
−
Inak zistí, či je na pravom senzore tma, točí do prava, kým nevidí na oboch svetlo.
 
  
−
'''Výpis činnosti robota'''
 
  
−
Keď je spustený mód nasledovania čiary, pri každom prechode cyklom vypíše na nový riadok do programu putty jedno z písmen "r,p,l". r ak ide rovno, p - zabáča doprava, l - zabáča doľava.
+
'''Autor:''' Adam Dudík, Patrik Kemény
−
Po tom ako robota zastavíme, treba ručne z programu putty skopírovať celý výstup a uložiť do textového formátu (.txt).
 

Latest revision as of 10:48, 12 June 2013

Úvod

Našou úlohou bolo naprogramovať Acrob robota tak aby sa hýbal smerom dopredu sledovaním čiary a popritom meral vzdialenosti okolitých objektov. Na sledovanie čiary sme použili dva svetelné čiarové senzory. Na zisťovanie vzdialenosti okolitých objektov sme použili IR senzor. Použili sme iba jeden senzor umiestnený na ľavom boku robota.

Zapojenie

Svetelne senzory popisky.png

Ir senzor popisky.png

Zapajanie popisky.png

Opis aplikácie

Aplikácia sa delí na dve logické časti. V prvej sa vykoná takzvaný SETUP robota, kde sa inicializujú jeho vnútorné premenné. V druhej časti sme definovali samotnú funkcionalitu robota. Základné funkcie, ktoré robot vykonáva sú sledovanie čiary a mapovanie okolitého prostredia.

Sledovanie čiary

Aplikácia spracováva dáta, ktoré mu boli sprostredkované pomocou čiarových senzorov na podvozku robota. Tieto hodnoty si uchováva vo svojich vnútorných premenných a ďalej ich spracováva. Ak sa čiarový senzor nachádza nad tmavým povrchom, reprezentovaným vodiacou čiarou, nasnímané hodnoty sú vysoké. Ak sa sníma bieli povrch na ktorom sa robot pohybuje, tak sú nasnímané hodnoty veľmi nízke. Vďaka týmto veľkým rozdielom sme schopný detegovať jeho pozíciu. Pohyb robota prebieham týmto spôsobom. Ak sa nasnímali nízke hodnoty na pravom senzore aj ľavom tak sa robot pohybuje rovno. Vodiaca čiara sa nachádza medzi senzormi. Ak robot deteguje, že jeden senzor zaznamenal rapídny nárast hodnoty, aplikácia upraví pohyb robota tak aby sa vrátil do pôvodnej dráhy a dostal vodiacu čiaru medzi čiarové senzory.

Mapovanie prostredia

Mapovanie prebieha za behu robota. Aplikácia vo vnútri robota vykonáva nie len snímanie povrchu ale zaznamenáva aj okolie robota. Okolie je snímané pomocou IR senzora. Jeho výstupy sú spracované špeciálne navrhnutými algoritmami na mapovanie. Algoritmus spracováva vzdialenosť okolitých objektov, ktoré boli zaznamenané ako tok znakov reprezentujúcich vzdialenosti. Pre jednoduchšie spracovanie a následnú vizualizáciu dát sme tieto namerané dáta predelili konštantou.


Zdrojový kód

Ukážka podmieneného smeru pohybu robota

Situácia : Ľavý čiarový senzor narazil na vodiacu čiaru a je potrebné vykonať korekciu pohybu doľava. 

if (val_senzor_l > 200) {   
  Lavy_motor.write(90+SLOW);
  Pravy_motor.write(90+SLOW);
  delay(800);
  Lavy_motor.write(90 - SLOW);  
  Pravy_motor.write(90 + SLOW); 
  delay(500);
}

Ukážka procesu mapovania 

Skreslena_vzdialenost = val_infra_1 / 80;               //hodnotu senzora predelim konstantou ktora bola optimalizovana
if (Skreslena_vzdialenost < 10) {                       //vdaka optimalizovanej konstante by hodnota nemala prekrocit desat
  CelaMapa += String( 10 - Skreslena_vzdialenost, DEC); //zapisem nameranu hodnotu do stringu
  CelaMapa += String( " ");                             //pridam medzeru za kazdou hodnotou
}

zdrojový kód Media:Projekt_d_k.zip

Výstup


video mapovania [1]


Ukážka z výstupného textového okna programu Arduino

Mapa pomlcky.png


Graf z výstupných hodnôt

Graf mapa prekazok.png


Autor: Adam Dudík, Patrik Kemény

Retrieved from "https://wiki.robotika.sk/robowiki/index.php?title=Pohyb_robota_po_čiare_a_zaznamenávanie_vzdialenosti_okolitých_objektov_(Dudík,_Kemény)&oldid=6468"