Advertisement
talofer99

trg/echo 2 ultrasonic

Jun 14th, 2019
107
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.07 KB | None | 0 0
  1. #define TOTALUINTS 2
  2.  
  3. byte trigPin[TOTALUINTS] = {6, 8};
  4. byte echoPin[TOTALUINTS] = {7.9};
  5.  
  6. int trigPin2 = 8;
  7. int echoPin2 = 9;
  8.  
  9. void setup() {
  10.   Serial.begin (9600);
  11.   for (byte i = 0; i < TOTALUINTS ; i++) {
  12.     pinMode(trigPin[i], OUTPUT);
  13.     pinMode(echoPin[i], INPUT);
  14.   }
  15.  
  16. }
  17.  
  18.  
  19. void runProcess(byte trigPin, byte echoPin) {
  20.   long duration, distance;
  21.   digitalWrite(trigPin, LOW);  // Added this line
  22.   delayMicroseconds(2); // Added this line
  23.   digitalWrite(trigPin, HIGH);
  24.   delayMicroseconds(10); // Added this line
  25.   digitalWrite(trigPin, LOW);
  26.   duration = pulseIn(echoPin, HIGH);
  27.   distance = (duration / 2) / 29.1;
  28.  
  29.   if (distance >= 500 || distance <= 0) {
  30.     Serial.println("Distance Left: Out of range");
  31.   }
  32.   else {
  33.     Serial.print("Distance Left:  ");
  34.     Serial.print(distance);
  35.     Serial.print(" cm - ");
  36.     float LDin = ( distance / 2.54 );
  37.     Serial.print(LDin);
  38.     Serial.println(" in");
  39.   }
  40. }
  41.  
  42.  
  43. void loop() {
  44.   for (byte i = 0; i < TOTALUINTS ; i++) {
  45.     runProcess(trigPin[i], echoPin[i]);
  46.     delay(500);
  47.   }
  48.  
  49.  
  50.  
  51.  
  52. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement