Advertisement
Guest User

Untitled

a guest
May 3rd, 2016
54
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.45 KB | None | 0 0
  1. #define trigPin 2
  2. #define echoPin 3
  3.  
  4. void setup() {
  5. Serial.begin (9600);
  6. pinMode(trigPin, OUTPUT); //Pin, do którego podłączymy trig jako wyjście
  7. pinMode(echoPin, INPUT); //a echo, jako wejście
  8. pinMode(7, OUTPUT); //Wyjście dla buzzera
  9. pinMode(8, OUTPUT);
  10. pinMode(9, OUTPUT);
  11. pinMode(10, OUTPUT);
  12. pinMode(11, OUTPUT);
  13. }
  14.  
  15. void loop() {
  16. zakres(0, 10);
  17. zakres2(10, 20);
  18. zakres3(20, 30);
  19. zakres4(30, 40);
  20. zakres5(40, 50);
  21. delay(100);
  22. }
  23.  
  24. int zmierzOdleglosc() {
  25. long czas, dystans;
  26.  
  27. digitalWrite(trigPin, LOW);
  28. delayMicroseconds(2);
  29. digitalWrite(trigPin, HIGH);
  30. delayMicroseconds(10);
  31. digitalWrite(trigPin, LOW);
  32.  
  33. czas = pulseIn(echoPin, HIGH);
  34. dystans = czas / 58;
  35.  
  36. return dystans;
  37. }
  38.  
  39. void zakres(int a, int b) {
  40. int jakDaleko = zmierzOdleglosc();
  41. if ((jakDaleko > a) && (jakDaleko < b))
  42. digitalWrite(7, HIGH); //Włączamy buzzer
  43. }
  44. void zakres2(int a, int b) {
  45. int jakDaleko = zmierzOdleglosc();
  46. if ((jakDaleko > a) && (jakDaleko <b ))
  47. digitalWrite(8, HIGH);
  48. }
  49. void zakres3(int a, int b) {
  50. int jakDaleko = zmierzOdleglosc();
  51. if ((jakDaleko > a) && (jakDaleko < b))
  52. digitalWrite(9, HIGH);
  53. }
  54. void zakres4(int a, int b) {
  55. int jakDaleko = zmierzOdleglosc();
  56. if ((jakDaleko > a) && (jakDaleko < b))
  57. digitalWrite(10, HIGH);
  58. }
  59. void zakres5(int a, int b) {
  60. int jakDaleko = zmierzOdleglosc();
  61. if ((jakDaleko > a) && (jakDaleko < b))
  62. digitalWrite(11, HIGH);
  63. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement