#include <Servo.h>
#include <LiquidCrystal.h>

int ledM = 7;
int ledH = 6;
int trig = 13;
int echo = 1;
long waktu;
int jarak;
Servo servo1;
LiquidCrystal lcd(8,10,11,12,7,6);

void setup(){
  pinMode(ledM, OUTPUT);
  pinMode(ledH, OUTPUT);
  pinMode(trig, OUTPUT);
  pinMode(echo, INPUT);
  servo1.attach(3);
  servo1.write(0);
  lcd.begin (16,2) ;
  lcd.setCursor (0,0) ;
  lcd.print ("hallo") ;
  delay (2000);
  lcd.clear() ;
  lcd.setCursor (0,0);
  lcd.print ("pengukur jarak");
}

void loop(){
  digitalWrite(trig, LOW);
  delayMicroseconds(2);
  digitalWrite(trig, HIGH);
  delayMicroseconds(10);
  digitalWrite(trig, LOW);
  waktu = pulseIn(echo, HIGH);
  jarak = waktu*0.0343/2;

  if(jarak<=200){
    digitalWrite(ledM, HIGH);
    digitalWrite(ledH, LOW);
    servo1.write(90);
  }
  else{
    digitalWrite(ledH, HIGH);
    digitalWrite(ledM, LOW);
    servo1.write(0);
    }
lcd.setCursor (0,1);
lcd.print ("jarak = ");
lcd.print (jarak) ;
lcd.print (" cm ");
}