Differences

This shows you the differences between two versions of the page.

Link to this comparison view

Both sides previous revisionPrevious revision
Next revision
Previous revision
et:examples:sensor:ultrasonic_distance [2015/02/26 12:59] raivo.sellet:examples:sensor:ultrasonic_distance [2020/07/20 09:00] (current) – external edit 127.0.0.1
Line 3: Line 3:
 //Vajalikud teadmised: [HW] [[et:hardware:homelab:digi]],  //Vajalikud teadmised: [HW] [[et:hardware:homelab:digi]], 
 [AVR] [[et:avr:timers]],  [AVR] [[et:avr:timers]], 
-[LIB] [[et:software:homelab:library:timer]], [LIB] [[et:software:homelab:library:module:lcd_graphic]], [LIB] [[et:software:homelab:library:module:sensor]] //+[LIB] [[et:software:homelab:library:timer]], \\ 
 +[LIB] [[et:software:homelab:library:module:lcd_graphic]], [LIB] [[et:software:homelab:library:module:sensor]] //
  
 ===== Teooria ===== ===== Teooria =====
Line 18: Line 19:
 ===== Praktika ===== ===== Praktika =====
  
-Kodulabori Andurite mooduli komplektis on Devantech SRF04 või SRF05 ultraheli kaugusmõõdik. SRF04/SRF05 on ainult andur, mis otseselt kauguse infot ei väljasta. Anduril on peale toiteviikude veel päästiku ja kaja viik. Üks oluline erinevus andurite SRF04 ja SRF05 vahel on see, et SRF05-l on võimalik nii päästiku kui ka kaja signaali jaoks kasutada ühte füüsilist viiku. See võimaldab andurit kasutada standardse kolme-viigu pistikuga (toide, maa ja signaal). Päästiku viiku kõrgeks seades genereerib andur 8-perioodilise 40 kHz ultraheli laine. Sel hetkel läheb kõrgeks kaja viik ja jääb kõrgeks niikauaks, kuni peegeldunud helilaine on andurini jõudnud. Seega põhimõtteliselt näitab kaja signaal aega, mille jooksul heli levib objektini ja tagasi. Mõõtes seda aega, korrutades seda heli levimise kiirusega ja jagades kahega, saab leida objekti kauguse. +Robootika Kodulabori lisakomplektis on Devantech SRF04 või SRF05 ultraheli kaugusmõõdik. SRF04/SRF05 on ainult andur, mis otseselt kauguse infot ei väljasta. Anduril on peale toiteviikude veel päästiku ja kaja viik. Üks oluline erinevus andurite SRF04 ja SRF05 vahel on see, et SRF05-l on võimalik nii päästiku kui ka kaja signaali jaoks kasutada ühte füüsilist viiku. See võimaldab andurit kasutada standardse kolme-viigu pistikuga (toide, maa ja signaal). Päästiku viiku kõrgeks seades genereerib andur 8-perioodilise 40 kHz ultraheli laine. Sel hetkel läheb kõrgeks kaja viik ja jääb kõrgeks niikauaks, kuni peegeldunud helilaine on andurini jõudnud. Seega põhimõtteliselt näitab kaja signaal aega, mille jooksul heli levib objektini ja tagasi. Mõõtes seda aega, korrutades seda heli levimise kiirusega ja jagades kahega, saab leida objekti kauguse. 
  
 Devantech-i ultrahelianduri AVR-iga kasutamiseks tuleb selle päästiku ja kaja viigud ühendada mõnede AVR-i viikudega. Aja mõõtmiseks on sobiv kasutada 16-bitist taimerit, näiteks //timer3//. Järgnevalt on toodud funktsioon ATmega2561 kontrolleri näitel, mis teostab kogu mõõtmisprotseduuri - genereerib päästiku signaali, käivitab taimeri, mõõdab kajasignaali pikkust ja teisendab selle kauguseks sentimeetrites. Funktsioon on blokeeruv ehk protsessor on sellega hõivatud senikaua, kuni mõõtetulemus on käes või mõõtmine venib lubatust pikemaks. Mida kiiremini kaja saabub, seda kiiremini saab mõõtetulemuse. Kui kaja ei saabugi, ootab funktsioon seda ~36 ms ja tagastab seejärel 0. Oluline on mõõtmiste vahele jätta mõnikümmend millisekundit pausi, et eelmisel mõõtmisel tekitatud helilaine jõuaks sumbuda ega rikuks uut mõõtmist. Kui kasutatakse samaaegselt mitut ultraheli andurit, tuleb samuti jälgida, et helilained ei kattuks. Devantech-i ultrahelianduri AVR-iga kasutamiseks tuleb selle päästiku ja kaja viigud ühendada mõnede AVR-i viikudega. Aja mõõtmiseks on sobiv kasutada 16-bitist taimerit, näiteks //timer3//. Järgnevalt on toodud funktsioon ATmega2561 kontrolleri näitel, mis teostab kogu mõõtmisprotseduuri - genereerib päästiku signaali, käivitab taimeri, mõõdab kajasignaali pikkust ja teisendab selle kauguseks sentimeetrites. Funktsioon on blokeeruv ehk protsessor on sellega hõivatud senikaua, kuni mõõtetulemus on käes või mõõtmine venib lubatust pikemaks. Mida kiiremini kaja saabub, seda kiiremini saab mõõtetulemuse. Kui kaja ei saabugi, ootab funktsioon seda ~36 ms ja tagastab seejärel 0. Oluline on mõõtmiste vahele jätta mõnikümmend millisekundit pausi, et eelmisel mõõtmisel tekitatud helilaine jõuaks sumbuda ega rikuks uut mõõtmist. Kui kasutatakse samaaegselt mitut ultraheli andurit, tuleb samuti jälgida, et helilained ei kattuks.
Line 28: Line 29:
 unsigned short ultrasonic_measure_srf05(pin triggerecho) unsigned short ultrasonic_measure_srf05(pin triggerecho)
 {  {
- // Viikude seadistus+ // Viikude seadistamine
  pin_setup_output(triggerecho);  pin_setup_output(triggerecho);
  
- // Taimer 3 normaalrežiimi+ // Taimer 3 normaalrežiimi seadistamine
  // perioodiga F_CPU / 8  // perioodiga F_CPU / 8
  timer3_init_normal(TIMER3_PRESCALE_8);  timer3_init_normal(TIMER3_PRESCALE_8);
  
- // Päästiku viik kõrgeks+ // Päästiku viigu kõrgeks määramine
  pin_set(triggerecho);  pin_set(triggerecho);
   
Line 45: Line 46:
  while (timer3_get_value() < 18) {}  while (timer3_get_value() < 18) {}
   
- // Päästiku viik madalaks+ // Päästiku viigu madalaks määramine
  pin_clear(triggerecho);  pin_clear(triggerecho);
  
Line 54: Line 55:
  while (!pin_get_value(triggerecho))  while (!pin_get_value(triggerecho))
  {  {
- // Liiga kaua oodatud ?+ // Liiga kaua oodatud?
  if (timer3_overflow_flag_is_set())  if (timer3_overflow_flag_is_set())
  {  {
Line 67: Line 68:
  while (pin_get_value(triggerecho))  while (pin_get_value(triggerecho))
  {  {
- // Liiga kaua oodatud ?+ // Liiga kaua oodatud?
  if (timer3_overflow_flag_is_set())  if (timer3_overflow_flag_is_set())
  {  {
Line 84: Line 85:
 [{{ :examples:sensor:ultrasonic_distance:srf05p2.jpg?400|SRF05 ühendusviigud}}] [{{ :examples:sensor:ultrasonic_distance:srf05p2.jpg?400|SRF05 ühendusviigud}}]
 */ */
-Toodud funktsioon jätab päästiku / kaja viigu kasutaja valida, nii et andurit saab ühendada sinna, kus on sobivam või kus on ruumi. Lisaks võimaldab viige valiku vabadus funktsiooni kasutada ka mujal kui Kodulabori komplektis. Toodud funktsioon kuulub ka Kodulabori teeki, nii et seda ei pea oma programmi eraldi kirjutama. Peab aga arvestama, et Kodulabori teegis on see funktsioon jäigalt seotud Kodulabori Kontrollermooduli taktsagedusega ja muude taktsageduste puhul annaks funktsioon vale tulemuse. Muu taktsageduse korral tuleb see funktsioon ise oma programmmi kirjutada. Järgnevalt esitatud programmikood demonstreerib SRF05 ultrahelianduri kasutamist Kodulabori teegiga. Anduri ühendamisel on väga oluline jälgida toite polaarsust. Valepidi ühendamisel muutub andur töökõlbmatuks.+Toodud funktsioon jätab päästiku / kaja viigu kasutaja valida, nii et andurit saab ühendada sinna, kus on sobivam või kus on ruumi. Lisaks võimaldab viige valiku vabadus funktsiooni kasutada ka mujal kui Kodulabori komplektis. Toodud funktsioon kuulub ka Kodulabori teeki, nii et seda ei pea oma programmi eraldi kirjutama. Peab aga arvestama, et Kodulabori teegis on see funktsioon jäigalt seotud Kodulabori Kontrollermooduli taktsagedusega ja muude taktsageduste puhul annaks funktsioon vale tulemuse. Muu taktsageduse korral tuleb see funktsioon ise oma programmi kirjutada. Järgnevalt esitatud programmikood demonstreerib SRF05 ultrahelianduri kasutamist Kodulabori teegiga. Anduri ühendamisel on väga oluline jälgida toite polaarsust. Valepidi ühendamisel muutub andur töökõlbmatuks.
  
 <code c> <code c>
Line 97: Line 98:
 // Ultraheli SRF05 anduri signaali viik // Ultraheli SRF05 anduri signaali viik
 // Kodulabor II // Kodulabor II
-// pin pin_trigger_echo = PIN(F, 2);+//pin pin_trigger_echo = PIN(F, 2);
  
 // Kodulabor III // Kodulabor III
Line 125: Line 126:
  
   // Lõputu tsükkel   // Lõputu tsükkel
- while (true)+ while (1)
  {  {
  // Mõõtmine  // Mõõtmine
  distance = ultrasonic_measure_srf05(pin_trigger_echo);  distance = ultrasonic_measure_srf05(pin_trigger_echo);
  
- // Mõõtmine õnnestus ?+ // Mõõtmine õnnestus?
  if (distance > 0)  if (distance > 0)
  {   {
  // Kauguse tekstiks teisendamine  // Kauguse tekstiks teisendamine
- sprintf(text, "%cm   ", distance);+ sprintf(text, "%3d cm   ", distance);
  }  }
- // Mõõtmisel tekkis viga ?+ // Mõõtmisel tekkis viga?
  else  else
  {  {
et/examples/sensor/ultrasonic_distance.1424955547.txt.gz · Last modified: 2020/07/20 09:00 (external edit)
CC Attribution-Share Alike 4.0 International
www.chimeric.de Valid CSS Driven by DokuWiki do yourself a favour and use a real browser - get firefox!! Recent changes RSS feed Valid XHTML 1.0