Advertisement
Guest User

bono

a guest
Dec 4th, 2017
206
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.83 KB | None | 0 0
  1. void loop()
  2. {
  3.  
  4.     digitalWrite(Trig, LOW);
  5.     delay(5);
  6.     digitalWrite(Trig, HIGH);
  7.     delay(10);
  8.     digitalWrite(Trig, LOW);
  9.     dauer = pulseIn(Echo, HIGH);
  10.     entfernung = (dauer/2) * 0.03432;
  11.    
  12.     if (entfernung >= 1000 || entfernung <= 0)
  13.     {
  14.         Serial.println("Kein Messwert");
  15.     }
  16.     else
  17.     {
  18.         Serial.print(entfernung);
  19.         Serial.println(" cm");
  20.     }  
  21.    
  22.     getstr = Serial.read();
  23.    
  24.     switch(getstr)
  25.     {
  26.         case 'a':
  27.             stateChange();
  28.             break;
  29.            
  30.         case 'f':
  31.             if (entfernung >= 80)
  32.             {
  33.                 forward();
  34.             }
  35.             else
  36.             {
  37.                 stop();
  38.             }
  39.             break;
  40.            
  41.         case 'b':
  42.             back();
  43.             break;
  44.            
  45.         case 'l':
  46.             left();
  47.             break;
  48.            
  49.         case 'r':
  50.             right();
  51.             break;
  52.            
  53.         case 's':
  54.             stop();
  55.             break;
  56.            
  57.         default:  
  58.             break;
  59.     }      
  60.    
  61.     delay(100);              
  62. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement