#define ECHO_PIN 2
#define TRIG_PIN 15
void setup() {
// put your setup code here, to run once:
Serial.begin(115200);
//Serial.println("Hello, ESP32!");
pinMode(LEND, OUTPUT);
pinMode(TRIG_PIN, OUTPUT);
pinMode(ECHO_PIN, INPUT);
pinMode(5, OUTPUT); //merah
pinMode(18, OUTPUT); //hijau
pinMode(19, OUTPUT); //biru
pinMode(21, OUTPUT); //ungu
pinMode(4, OUTPUT); //buzzer
}
void loop() {
// put your main code here, to run repeatedly:
//delay(10); // this speeds up the simulation
digitalWrite(TRIG_PIN, LOW);
delayMicroseconds(2);
digitalWrite(TRIG_PIN, HIGH);
delayMicroseconds(10);
digitalWrite(TRIG_PIN, LOW);
int duration=pulseIn(ECHO_PIN,HIGH);
float distance=duration*0.034/2;
if(distance>50){
digitalWrite(21, HIGH);
digitalWrite(19, LOW);
digitalWrite(18, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
}
if(distance>100){
digitalWrite(21, HIGH);
digitalWrite(19, HIGH);
digitalWrite(18, LOW);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
}
if(distance>200){
digitalWrite(21, HIGH);
digitalWrite(19, HIGH);
digitalWrite(18, HIGH);
digitalWrite(5, LOW);
digitalWrite(4, LOW);
}
if(distance>300){
digitalWrite(21, HIGH);
digitalWrite(19, HIGH);
digitalWrite(18, HIGH);
digitalWrite(5, HIGH);
digitalWrite(4, HIGH);
}
Serial.print("Jarak : ");
Serial.println(distance);
delay(100);
}