Advertisement
Guest User

Untitled

a guest
Jun 15th, 2019
61
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 1.47 KB | None | 0 0
  1. #define trigPin 13
  2. #define echoPin 12
  3. #define BPin 7
  4. #define piezoPin 9
  5. #define RPin 4
  6. #define GPin 8
  7.  
  8. void setup() {
  9. Serial.begin (9600);
  10. pinMode(trigPin, OUTPUT);
  11. pinMode(echoPin, INPUT);
  12. pinMode(BPin, OUTPUT);
  13. pinMode(piezoPin, OUTPUT);
  14. pinMode(RPin, OUTPUT);
  15. pinMode(GPin, OUTPUT);
  16. }
  17.  
  18. void loop() {
  19. long duration, distance;
  20. digitalWrite(trigPin, LOW);
  21. delayMicroseconds(2);
  22. digitalWrite(trigPin, HIGH);
  23. delayMicroseconds(10);
  24. digitalWrite(trigPin, LOW);
  25. duration = pulseIn(echoPin, HIGH);
  26. distance = (duration/2) / 29.1;
  27. if (distance >= 200 || distance <= 0){
  28. Serial.println("Out of range");
  29. }
  30.  
  31.  
  32. else {
  33. Serial.print(distance);
  34. Serial.println(" cm");
  35. }
  36. delay(1000);
  37. {if (distance <= 25 || distance <= 0){
  38. digitalWrite(RPin, HIGH);
  39. }
  40. else{
  41. digitalWrite(RPin, LOW);
  42.  
  43. }
  44.  
  45. }
  46. {
  47. if (distance >= 25 && distance <= 50){
  48. digitalWrite(GPin, HIGH);
  49. }
  50. else {
  51. digitalWrite(GPin, LOW);
  52. }
  53.  
  54.  
  55.  
  56. { if (distance >= 50 && distance <= 75){
  57. digitalWrite(GPin, HIGH);
  58. }
  59. else {
  60. digitalWrite(BPin, LOW);
  61. }
  62. {if (distance >= 75 && distance <= 100){
  63. digitalWrite(BPin, HIGH);
  64. }
  65. else {
  66. digitalWrite(GPin, LOW);
  67. {
  68. {if (distance >= 100 && distance <= 200){
  69. digitalWrite(piezoPin, HIGH);
  70. }
  71. else {
  72. digitalWrite(piezoPin, LOW);
  73. }
  74. }
  75. }
  76. }
  77. }
  78. }
  79. }
  80. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement