#include <Wire.h>
#include <LiquidCrystal_I2C.h>
#include <Servo.h>

const int trigPin1 = 2;
const int echoPin1 = 3;
const int trigPin2 = 4;
const int echoPin2 = 5;

const int ledPin1 = 6;
const int ledPin2 = 7;

Servo servo1;
Servo servo2;

const int servoPin1 = 8;
const int servoPin2 = 9;

long duration1, distance1;
long duration2, distance2;

LiquidCrystal_I2C lcd(0x27, 16, 2);

void setup() {
Serial.begin(9600);

pinMode(trigPin1, OUTPUT);
pinMode(echoPin1, INPUT);
pinMode(trigPin2, OUTPUT);
pinMode(echoPin2, INPUT);

pinMode(ledPin1, OUTPUT);
pinMode(ledPin2, OUTPUT);

servo1.attach(servoPin1);
servo2.attach(servoPin2);

lcd.init();
lcd.backlight();
lcd.print("Sabar ...  ");
delay(1000);
}

void loop() {
distance1 = getDistance(trigPin1, echoPin1);
distance2 = getDistance(trigPin2, echoPin2);

Serial.print("jarak 1: ");
Serial.print(distance1);
Serial.print(" cm, jarak 2: ");
Serial.print(distance2);
Serial.println(" cm");

lcd.clear();
lcd.setCursor(0, 0);
lcd.print("Jarak: ");
lcd.print(distance1);
lcd.print(" cm");
lcd.setCursor(0, 1);
lcd.print("Jarak: ");
lcd.print(distance2);

lcd.print(" cm");

if (distance1 < 150) {
servo1.write(180); 
digitalWrite(ledPin1, HIGH); 
 } else {
servo1.write(0); 
digitalWrite(ledPin1, LOW); 
 }

if (distance2 < 150)  {
servo2.write(180); 
digitalWrite(ledPin2, HIGH); 
 } else {
servo2.write(0); 
digitalWrite(ledPin2, LOW); 
 }
delay(200);

 }
long getDistance(int trigPin, int echoPin) {
digitalWrite(trigPin, LOW);

delayMicroseconds(2);

digitalWrite(trigPin, HIGH);

delayMicroseconds(10);

digitalWrite(trigPin, LOW);

long duration = pulseIn(echoPin, HIGH);

long distance = duration * 0.034 / 2;

return distance;
 }