Wpis z mikrobloga

#arduino #hc-SR04

Dokładny pomiar z użyciem dwóch czujników

#define TRIG 2 //HC-SR04 czujnik 1
#define ECHO 3 //HC-SR04 czujnik 1
#define TRIG1 4 //HC-SR04 czujnik 2
#define ECHO1 5 //HC-SR04 czujnik 2

void setup() {
pinMode(TRIG,OUTPUT);
pinMode(ECHO,INPUT);
pinMode(TRIG1,OUTPUT);
pinMode(ECHO1,INPUT);
Serial.begin(9600);
}

float pomiar(){
unsigned long czas;
digitalWrite(TRIG,HIGH);
delayMicroseconds(10);
digitalWrite(TRIG,LOW);
czas = pulseIn(ECHO,HIGH);
return czas / 58.00;
}
float pomiar1(){
unsigned long czas1;
digitalWrite(TRIG1,HIGH);
delayMicroseconds(10);
digitalWrite(TRIG1,LOW);
czas1 = pulseIn(ECHO1,HIGH);
return czas1 / 58.00;
}

void loop() {
Serial.print("Odleglosc: ");
Serial.print(pomiar());
Serial.print("cm");
Serial.print(" Odleglosc1: ");
Serial.print(pomiar1());
Serial.println("cm");
delay(50);
}
  • 2