Advertisement
Guest User

Untitled

a guest
Nov 15th, 2019
83
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.13 KB | None | 0 0
  1. #define trigPin 12
  2. #define echoPin 11
  3. #define RED 4
  4. #define YELLOW 3
  5. #define GREEN 2
  6. void setup() {
  7. Serial.begin (9600);
  8. pinMode(trigPin, OUTPUT); //Pin, do którego podłączymy trig jako wyjście
  9. pinMode(echoPin, INPUT); //a echo, jako wejście
  10. pinMode(GREEN, OUTPUT);
  11. digitalWrite(GREEN, LOW);
  12. pinMode(YELLOW, OUTPUT);
  13. digitalWrite(YELLOW, LOW);
  14. pinMode(RED, OUTPUT);
  15. digitalWrite(RED, LOW);
  16.  
  17.  
  18.  
  19. Serial.begin(9600);
  20. }
  21.  
  22. void loop() {
  23. Serial.println(proximity());
  24. controlLED(proximity());
  25. delay(250);
  26. }
  27.  
  28. int proximity() {
  29. long czas, dystans;
  30.  
  31. digitalWrite(trigPin, LOW);
  32. delayMicroseconds(2);
  33. digitalWrite(trigPin, HIGH);
  34. delayMicroseconds(10);
  35. digitalWrite(trigPin, LOW);
  36.  
  37. return pulseIn(echoPin, HIGH);
  38. }
  39.  
  40. void controlLED(int a) {
  41. if (a <= 300) {
  42. digitalWrite(GREEN, HIGH);
  43. digitalWrite(YELLOW, LOW);
  44. digitalWrite(RED, LOW);
  45. }else if(a>300 && a<=700){
  46. digitalWrite(YELLOW, HIGH);
  47. digitalWrite(GREEN, LOW);
  48. digitalWrite(RED, LOW);
  49. }else{
  50. digitalWrite(RED, HIGH);
  51. digitalWrite(GREEN, LOW);
  52. digitalWrite(YELLOW, LOW);
  53.  
  54. }
  55. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement