#define SOUND_SPEED 0.034 #define TIMEOUT 30000 const int trigPinL = 33; const int echoPinL = 32; const int trigPinR = 15; const int echoPinR = 18; long durationL, durationR; float distanceCmL, distanceCmR; void setup() { Serial.begin(115200); pinMode(trigPinL, OUTPUT); pinMode(echoPinL, INPUT); pinMode(trigPinR, OUTPUT); pinMode(echoPinR, INPUT); } void loop() { digitalWrite(trigPinL, LOW); delayMicroseconds(2); digitalWrite(trigPinL, HIGH); delayMicroseconds(10); digitalWrite(trigPinL, LOW); durationL = pulseIn(echoPinL, HIGH, TIMEOUT); distanceCmL = (durationL > 0) ? (durationL * SOUND_SPEED / 2) : -1; delay(50); digitalWrite(trigPinR, LOW); delayMicroseconds(2); digitalWrite(trigPinR, HIGH); delayMicroseconds(10); digitalWrite(trigPinR, LOW); durationR = pulseIn(echoPinR, HIGH, TIMEOUT); distanceCmR = (durationR > 0) ? (durationR * SOUND_SPEED / 2) : -1; Serial.println("Distance (cm):"); Serial.print("Right: "); Serial.println(distanceCmR); Serial.print("Left: "); Serial.println(distanceCmL); delay(500); }