#define trigPin 11
#define echoPin 12

// #include <NewPing.h>
#include <Wire.h>
#include <LiquidCrystal_I2C.h>

LiquidCrystal_I2C lcd(0x27, 16, 2);

#define MAX_DISTANCE 200
// NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);
void setup() {
  lcd.init();
   pinMode(A4, INPUT);
   pinMode(A5, INPUT);
      
      pinMode(1, OUTPUT);
      pinMode(2, OUTPUT);
      pinMode(3, OUTPUT);

  Serial.begin(9600);

}
void loop() {

   int a = analogRead(A4);
   int b = analogRead(A5);
  int pwm = map (a,0,700,0,100);

  if (pwm <= 33)
  {
    digitalWrite(1, LOW);
     digitalWrite(2, LOW);
      digitalWrite(3, HIGH);
  }
  else if (pwm >= 34 && pwm <=66)
  {
    digitalWrite(1, LOW);
     digitalWrite(2, HIGH);
      digitalWrite(3, HIGH);
  }

  else if (pwm >= 65 && pwm <=99)
  {
    digitalWrite(1, HIGH);
     digitalWrite(2, HIGH);
      digitalWrite(3, HIGH);
  } else if (pwm >= 100 )
  {
    digitalWrite(1, HIGH);
     digitalWrite(2, HIGH);
      digitalWrite(3, HIGH);

      delay(250);

    digitalWrite(1, LOW);
     digitalWrite(2, LOW);
      digitalWrite(3, LOW);

      delay(250);

  }
  lcd.setCursor(2, 0);
  lcd.print("21.11.4282 ");
  lcd.setCursor(0, 1);
  lcd.print("Jarak : ");
  lcd.setCursor(9, 1);
  lcd.print(pwm);
  lcd.setCursor(13, 1);
  lcd.print("cm");

  delay(500);
  lcd.clear();
}