int trig = 2;
int echo = 4;
void setup() {
Serial.begin(115200);
pinMode(trig,OUTPUT);
pinMode(echo,INPUT);
pinMode(16,OUTPUT);
pinMode(17,OUTPUT);
pinMode(5,OUTPUT);
pinMode(18,OUTPUT);
pinMode(15,OUTPUT);
}
void loop() {
digitalWrite(trig,HIGH);
delayMicroseconds(50);
digitalWrite(trig,LOW);
delayMicroseconds(50);
digitalWrite(trig,HIGH);
delayMicroseconds(50);
int bacaultra = pulseIn(echo,HIGH);
int jarak = bacaultra/48;
Serial.print("jarak= ");
Serial.println(jarak);
if(jarak >= 50){
Serial.println("1led");
digitalWrite(16,HIGH);
digitalWrite(17,LOW);
digitalWrite(5,LOW);
digitalWrite(18,LOW);
delay(20);
}
delay(20);
if(jarak >= 100){
Serial.println("2led");
digitalWrite(16,HIGH);
digitalWrite(17,HIGH);
digitalWrite(5,LOW);
digitalWrite(18,LOW);
delay(20);
}
delay(20);
if(jarak >= 200){
Serial.println("3led");
digitalWrite(5,HIGH);
digitalWrite(16,HIGH);
digitalWrite(17,HIGH);
digitalWrite(18,LOW);
delay(20);
}
delay(20);
if(jarak >= 300){
Serial.println("4led+buzzer");
digitalWrite(5,HIGH);
digitalWrite(16,HIGH);
digitalWrite(17,HIGH);
digitalWrite(18,HIGH);
digitalWrite(15,HIGH);
delay(20);
}
}