Nie możesz wybrać więcej, niż 25 tematów Tematy muszą się zaczynać od litery lub cyfry, mogą zawierać myślniki ('-') i mogą mieć do 35 znaków.

main_Serv_Sensor.ino 1.4 KiB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869
  1. // ---------------------------------------------------------------- //
  2. // Arduino Ultrasoninc Sensor HC-SR04
  3. // Re-writed by Arbi Abdul Jabbaar
  4. // Using Arduino IDE 1.8.7
  5. // Using HC-SR04 Module
  6. // Tested on 17 September 2019
  7. // ---------------------------------------------------------------- //
  8. #define echoPin 2 // attach pin D2 Arduino to pin Echo of HC-SR04
  9. #define trigPin 3 //attach pin D3 Arduino to pin Trig of HC-SR04
  10. #include <Servo.h>
  11. Servo myServo;
  12. long duration;
  13. int distance;
  14. void setup() {
  15. pinMode(trigPin, OUTPUT);
  16. pinMode(echoPin, INPUT);
  17. pinMode(9, OUTPUT);
  18. pinMode(13, OUTPUT);
  19. digitalWrite(9, HIGH);
  20. Serial.begin(9600);
  21. Serial.println("Projet BTS Mathieu N.");
  22. Serial.println("BTS Ecole Technique EME");
  23. myServo.attach(10);
  24. myServo.write(5);
  25. }
  26. void loop() {
  27. digitalWrite(trigPin, LOW);
  28. delayMicroseconds(2);
  29. digitalWrite(trigPin, HIGH);
  30. delayMicroseconds(10);
  31. digitalWrite(trigPin, LOW);
  32. duration = pulseIn(echoPin, HIGH);
  33. distance = duration * 0.034 / 2;
  34. if (distance < 30 ) { ouverture(); }
  35. if (distance > 30) { Serial.println("-"); }
  36. }
  37. void ouverture(){
  38. Serial.println("Ouverture du bouchon");
  39. digitalWrite(13, HIGH);
  40. myServo.write(170);
  41. delay(1000);
  42. Serial.println("Fermeture du bouchon");
  43. digitalWrite(13, LOW);
  44. delay(2000);
  45. myServo.write(5);
  46. }