const int trigPin= 9;
const int echoPin =8;
#include <LiquidCrystal.h>
LiquidCrystal lcd(12,11,5,4,3,2);
void setup() {
Serial.begin(9600);
pinMode(trigPin, OUTPUT);
pinMode(echoPin, INPUT);
pinMode(5,OUTPUT);
lcd.begin(16,2);
pinMode(10, OUTPUT);
pinMode(11, OUTPUT);
pinMode(12, OUTPUT);
}
void loop() {
long jarak, waktu ;
int a = digitalRead(8);
int b = digitalRead(9);
digitalWrite(trigPin, LOW);
delayMicroseconds(2);
digitalWrite(trigPin, HIGH);
delayMicroseconds(10);
digitalWrite(trigPin, LOW);
waktu=pulseIn(echoPin, HIGH);
jarak=waktu/50;
delay(100);
lcd.setCursor(1,0);
lcd.print("Jarak = ");
lcd.print(jarak);
lcd.println(" Cm");
Serial.print("Jarak = ");
Serial.print(jarak);
Serial.println(" Cm");
if(jarak<=1 && jarak>=15){
digitalWrite(10, HIGH);
digitalWrite(11, LOW);
digitalWrite(12, LOW);}
else if(jarak<=16 && jarak>=50){
digitalWrite(10, HIGH);
digitalWrite(11, HIGH);
digitalWrite(12, LOW);}
else if(jarak<=51 && jarak>=100){
digitalWrite(10, HIGH);
digitalWrite(11, HIGH);
digitalWrite(12, HIGH);
}
}