const int ECHO_PINS[] = {25, 2, 18};
const int TRIG_PINS[] = {26, 15, 5};
const int LED_PINS[] = {13, 12, 14};
const int NUM_SENSORS = 3;
void setup() {
Serial.begin(115200);
for (int i = 0; i < NUM_SENSORS; i++) {
pinMode(LED_PINS[i], OUTPUT);
pinMode(TRIG_PINS[i], OUTPUT);
pinMode(ECHO_PINS[i], INPUT);
}
}
float readDistanceCM(int sensorNum) {
digitalWrite(TRIG_PINS[sensorNum], LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PINS[sensorNum], HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PINS[sensorNum], LOW);
int duration = pulseIn(ECHO_PINS[sensorNum], HIGH);
return duration * 0.034 / 2;
}
void loop() {
for (int i = 0; i < NUM_SENSORS; i++) {
float distance = readDistanceCM(i);
bool isNearby = distance > 200;
digitalWrite(LED_PINS[i], isNearby);
Serial.print("Measured distance sensor ");
Serial.print(i + 1);
Serial.print(": ");
Serial.println(distance);
}
delay(100);
}