Advertisement
Guest User

Untitled

a guest
Jun 21st, 2018
66
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 0.99 KB | None | 0 0
  1.  
  2. #include <Ultrasonic.h>
  3.  
  4. #define TRIGGER_PIN1  12
  5. #define ECHO_PIN1     13
  6. #define TRIGGER_PIN2  10
  7. #define ECHO_PIN2     11
  8.  
  9. Ultrasonic ultrasonic1(TRIGGER_PIN1, ECHO_PIN1);
  10. Ultrasonic ultrasonic2(TRIGGER_PIN2, ECHO_PIN2);
  11.  
  12. void setup()
  13.   {
  14.   Serial.begin(9600);
  15.   pinMode(2, OUTPUT);
  16.   pinMode(3, OUTPUT);
  17.   }
  18.  
  19. void loop()
  20.   {
  21.   float cmMsec1, cmMsec2;
  22.   long microsec1 = ultrasonic1.timing();
  23.   long microsec2 = ultrasonic2.timing();
  24.   cmMsec1 = ultrasonic1.convert(microsec1, Ultrasonic::CM);
  25.   cmMsec2 = ultrasonic2.convert(microsec2, Ultrasonic::CM);
  26.   Serial.print(cmMsec1);
  27.   Serial.print(" ; ");
  28.   Serial.println(cmMsec2);
  29.  
  30.  if (2<cmMsec1 && cmMsec1<4){
  31.     Serial.println("Detected1");
  32.     digitalWrite(2, 1);
  33.     digitalWrite(3, 0);
  34.   }
  35.     else{
  36.      digitalWrite(2, 0);
  37.   }
  38.    
  39.   if (2<cmMsec2 && cmMsec2<4){
  40.     Serial.println("Detected2");
  41.     digitalWrite(3, 1);
  42.     digitalWrite(2, 0);
  43.   }
  44.   else{
  45.      digitalWrite(3, 0);
  46.   }
  47.   delay(50);
  48.   }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement