Advertisement
elektronek

Michal Rybář - ultrasonic

Aug 26th, 2022
1,366
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
  1. int trigPin1 = 2;
  2. int echoPin1 = 3;
  3. int trigPin2 = 4;
  4. int echoPin2 = 5;
  5. int trigPin3 = 6;
  6. int echoPin3 = 7;
  7.  
  8. void setup() {
  9.   Serial.begin(9600);
  10.   pinMode ( trigPin1, OUTPUT ) ;
  11.   pinMode ( echoPin1, INPUT ) ;
  12.   pinMode ( trigPin2, OUTPUT ) ;
  13.   pinMode ( echoPin2, INPUT ) ;
  14.   pinMode ( trigPin3, OUTPUT ) ;
  15.   pinMode ( echoPin3, INPUT );
  16. }
  17.  
  18. void loop() {
  19.   long t = 0, h = 0, hp = 0, t2 = 0, h2 = 0, hp2 = 0, t3 = 0, h3 = 0, hp3 = 0;
  20.   //Transmitting pulse
  21.   digitalWrite(trigPin1, LOW);
  22.   delayMicroseconds(2);
  23.   digitalWrite(trigPin1, HIGH);
  24.   delayMicroseconds(10);
  25.   digitalWrite(trigPin1, LOW);
  26.   t = pulseIn(echoPin1, HIGH);
  27.   hp = t * 0.034 / 2;
  28.   Serial.print("Sensor 1:");
  29.   Serial.print(hp);
  30.   Serial.println(" cm");
  31.  
  32.   digitalWrite(trigPin2, LOW);
  33.   delayMicroseconds(2);
  34.   digitalWrite(trigPin2, HIGH);
  35.   delayMicroseconds(10);
  36.   digitalWrite(trigPin2, LOW);
  37.   t2 = pulseIn(echoPin2, HIGH);
  38.   hp2 = t2 * 0.034 / 2;  
  39.   Serial.print("Sensor 2:");
  40.   Serial.print(hp2);
  41.   Serial.println(" cm");
  42.  
  43.   //Transmitting pulse
  44.   digitalWrite(trigPin3, LOW);
  45.   delayMicroseconds(2);
  46.   digitalWrite(trigPin3, HIGH);
  47.   delayMicroseconds(10);
  48.   digitalWrite(trigPin3, LOW);
  49.   t3 = pulseIn(echoPin3, HIGH);
  50.   hp3 = t3 * 0.034 / 2;  
  51.   Serial.print("Sensor 3:");
  52.   Serial.print(hp3);
  53.   Serial.println(" cm");
  54.   delay(200);
  55. }  
  56.  
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement