int ECHO_PIN1 = 2;
int TRIG_PIN1 = 3;
int ECHO_PIN2 = 4;
int TRIG_PIN2 = 5;
int ledm = 13;
int ledh = 12;
int jarak1, jarak2, tahan1, tahan2;
void setup() {
Serial.begin(115200);
pinMode(ledm, OUTPUT);
pinMode(ledh, OUTPUT);
pinMode(TRIG_PIN1, OUTPUT);
pinMode(ECHO_PIN1, INPUT);
pinMode(TRIG_PIN2, OUTPUT);
pinMode(ECHO_PIN2, INPUT);
}
void jaraknya1() {
digitalWrite(TRIG_PIN1, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN1, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN1, LOW);
int duration1 = pulseIn(ECHO_PIN1, HIGH);
jarak1 = duration1 * 0.0343 / 2;
Serial.print("Jarak1: ");
Serial.println(jarak1);
}
void jaraknya2() {
digitalWrite(TRIG_PIN2, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN2, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN2, LOW);
int duration2 = pulseIn(ECHO_PIN2, HIGH);
jarak2 = duration2 * 0.0343 / 2;
Serial.print("Jarak2: ");
Serial.println(jarak2);
}
void loop() {
jaraknya1();
jaraknya2();
//if(jarak1 < 50){}
//if(jarak2 < 50){}
if (jarak1 < 50) {
tahan1=1;
}
if (tahan1 == 1 && jarak2 < 50 ) {
digitalWrite(ledm, HIGH);
delay(2000);
digitalWrite(ledm, LOW);
}
//////
if (jarak2 < 50) {
tahan2=1;
}
if (tahan2 == 1 && jarak1 < 50 ) {
digitalWrite(ledh, HIGH);
delay(2000);
digitalWrite(ledh, LOW);
}
if(tahan1==1 && tahan2==1 && jarak2>50 && jarak1>50){
tahan1=0;
tahan2=0;
}
}