#include <LiquidCrystal_I2C.h>
#include <Servo.h>
LiquidCrystal_I2C lcd (0x27, 16,2);
Servo servo1;
Servo servo2;

int trig_1=13;
int echo_1=12;
int trig_2=8;
int echo_2=7;

long jarak1, duration1;
long jarak2, duration2;

void setup() {
  lcd.begin(16,2);
  lcd.init() ;
  lcd.backlight();

  lcd.setCursor(0,0);
  lcd.print("Muhammad Hafid ");
  lcd.setCursor(0,1);
  lcd.print("XI TEI 2");
  delay(1000);
  lcd.clear();

  pinMode(trig_1,OUTPUT);
  pinMode(echo_1, INPUT);
  pinMode(echo_2, INPUT);
  pinMode(trig_2,OUTPUT);
  servo1.attach(3);
  servo2.attach(5);

}

void loop() {
  digitalWrite(trig_1,LOW);
  delayMicroseconds(2);
  digitalWrite(trig_1,HIGH);
  delayMicroseconds(10);
  digitalWrite(trig_1, LOW);

  duration1 = pulseIn(echo_1, HIGH);
  jarak1 = duration1 * 0,034/2;

  if(jarak1>=200){
    servo1. write(90);

  }else{
    servo1. write(0);}

    digitalWrite(trig_2, LOW);
    delayMicroseconds(2);
    digitalWrite(trig_2, HIGH);
    delayMicroseconds(10);
    digitalWrite(trig_2, LOW);

    duration2 = pulseIn(echo_2,  HIGH);
    jarak2 = duration2 * 0,034/2;

    if(jarak2 > 200){
      servo2. write(180);
    }else{
      servo2. write(0);
    }
  delay (100);
}