Advertisement
Guest User

Untitled

a guest
Mar 23rd, 2019
105
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.59 KB | None | 0 0
  1. int trigPin = 9;
  2. int echoPin =10;
  3. int buzer = 11;
  4.  
  5. int g1led = 2;
  6. int g2led = 3;
  7. int y1led = 4;
  8. int y2led = 5;
  9. int r1led = 6;
  10. int r2led = 7;
  11.  
  12. long czas;
  13. int dystans;
  14.  
  15. void linijka(int dg1, int dg2, int dy1, int dy2, int dr1, int dr2){
  16. digitalWrite(g1led, dg1);
  17. digitalWrite(g2led, dg2);
  18.  
  19. digitalWrite(y1led, dy1);
  20. digitalWrite(y2led, dy2);
  21.  
  22. digitalWrite(r1led, dr1);
  23. digitalWrite(r2led, dr2);
  24. }
  25.  
  26. void setup() {
  27. digitalWrite(buzer, LOW);
  28. pinMode(buzer,OUTPUT);
  29. pinMode(trigPin,OUTPUT);
  30. pinMode(echoPin,INPUT);
  31.  
  32. pinMode(g1led,OUTPUT);
  33. pinMode(g2led,OUTPUT);
  34.  
  35. pinMode(y1led,OUTPUT);
  36. pinMode(y2led,OUTPUT);
  37.  
  38. pinMode(r1led,OUTPUT);
  39. pinMode(r2led,OUTPUT);
  40. Serial.begin(9600);
  41. }
  42.  
  43. void loop() {
  44. Serial.println(dystans);
  45. digitalWrite(trigPin, LOW);
  46. delay(2);
  47. digitalWrite(trigPin, HIGH);
  48. delay(10);
  49. digitalWrite(trigPin, LOW);
  50.  
  51.  
  52. czas=pulseIn(echoPin, HIGH);
  53. dystans=czas*0.034/2;
  54.  
  55.  
  56. if(dystans>60)
  57. linijka(0,0,0,0,0,0);
  58.  
  59. if(dystans<=60 && dystans>50)
  60. linijka(1,0,0,0,0,0);
  61.  
  62.  
  63. if(dystans<=50 && dystans>40)
  64. linijka(1,1,0,0,0,0);
  65.  
  66. if(dystans<=40 && dystans>30)
  67. linijka(1,1,1,0,0,0);
  68.  
  69. if(dystans<=30 && dystans>20)
  70. {
  71. linijka(1,1,1,1,0,0);
  72. digitalWrite(buzer, HIGH);
  73. delay(200);
  74. digitalWrite(buzer, LOW);
  75. delay(200);
  76. }
  77.  
  78.  
  79. if(dystans<=20 && dystans>10){
  80. linijka(1,1,1,1,1,0);
  81. digitalWrite(buzer, HIGH);
  82. delay(100);
  83. digitalWrite(buzer, LOW);
  84. delay(100);
  85.  
  86. }
  87. if(dystans<=10 && dystans>0){
  88. linijka(1,1,1,1,1,1);
  89. digitalWrite(buzer, HIGH);
  90.  
  91. }
  92.  
  93. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement