Advertisement
Guest User

bono2

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