Ehrlich gesagt, verstehe ich deinen Sketch nicht. Dieser ist sehr unübersichtlich und es fehlen die Kommentare, damit außenstehende auch nachvollziehen können, was du da machst.
Zudem ist er schwer lesbar, da du diesen Quote-Tags gesetzt hast und nicht wie üblich in Code-Tags.
Das kannst du auch nachträglich noch ändern.
Ein Beispiel eines einfachen Beispiel-Sketches:
const int trigger = 7;
const int echo = 6;
long dauer = 0;
long entfernung = 0;
void setup() {
Serial.begin (9600);
pinMode(trigger, OUTPUT);
pinMode(echo, INPUT);
}
void loop() {
digitalWrite(trigger, LOW);
delayMicroseconds(5);
digitalWrite(trigger, HIGH); // Senden des Pulse
delayMicroseconds(10);
digitalWrite(trigger, LOW);
dauer = pulseIn(echo, HIGH); // Empfang des US-Pulse
entfernung = (dauer / 2) / 29.1; // Enfernungsberechnung
// Auswertung
if (entfernung >= 500 || entfernung <= 0) {
Serial.println("Kein Messwert");
}
else {
Serial.print(entfernung);
Serial.println(" cm");
}
delay(1000);
}
Teste ihn mal.
Du solltest aber darauf achten, dass die Sensoren sich nicht gegenseitig beeinflussen und nacheinander senden bzw. empfangen.
Dazwischen muss eine Pause sein, die groß genug ist, um diese Beeinflussung zu verhindern.