#define PIN_TRIG_S1 2
#define PIN_ECHO_S1 5
#define PIN_TRIG_S2 1
#define PIN_ECHO_S2 4
void setup() {
Serial.begin(115200);
Serial.println("Welcome to the Serial Monitor!");
Serial.println("---------------------------------");
pinMode(PIN_TRIG_S1, OUTPUT);
pinMode(PIN_ECHO_S1, INPUT);
pinMode(PIN_TRIG_S2, OUTPUT);
pinMode(PIN_ECHO_S2, INPUT);
}
float calcDistanceCM(int trigPin,int echoPin) {
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
int duration = pulseIn(echoPin, HIGH);
return duration * 0.034 / 2;
}
void loop() {
// put your main code here, to run repeatedly:
float distanceS1=calcDistanceCM(PIN_TRIG_S1,PIN_ECHO_S1);
float distanceS2=calcDistanceCM(PIN_TRIG_S2,PIN_ECHO_S2);
Serial.print("distanceS1:");
Serial.println(distanceS1);
Serial.print("distanceS2:");
Serial.println(distanceS2);
delay(1000);
}