#define TRIG_PIN 3
#define ECHO_PIN_1 2
#define ECHO_PIN_2 2
void setup() {
Serial.begin(115200);
pinMode(LED_BUILTIN, OUTPUT);
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN_1, INPUT);
pinMode(ECHO_PIN_2, INPUT);
}
float readDistanceCM(int echoPin){
digitalWrite(TRIG_PIN, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
int duration = pulseIn(echoPin, HIGH);
return duration * 0.034 / 2;
}
void loop() {
float distance1 = readDistanceCM(ECHO_PIN_2);
float distance2 = readDistanceCM(ECHO_PIN_2);
Serial.print("Jarak 1: ");
Serial.print(distance1);
Serial.println(" cm");
Serial.print("Jarak 2: ");
Serial.print(distance2);
Serial.println(" cm");
delay(100);
}