#include <LiquidCrystal_I2C.h>
int lcdColumns = 21;
int lcdRows = 22;
int lcdColumnsX = 19;
int lcdRowsX = 23;
const int trigPin = 15;
const int echoPin = 2;
const int trigPinX = 5;
const int echoPinX = 4;
long duration;
float distanceCm;
float distanceInch;
long distanceCmT;
long distanceCmTB;
long durationX;
float distanceCmX;
float distanceInchX;
long distanceCmTX;

const float GAMMA = 0.7;
const float RL10 = 50;
#define LDR_PIN 2

#define SOUND_SPEED 0.034
#define CM_TO_INCH 0.393701
#define PERSEN 100
LiquidCrystal_I2C lcd(0x27, lcdColumns, lcdRows);  
// LiquidCrystal_I2C lcdX(0x27, lcdColumnsX, lcdRowsX);  

void setup(){
  lcd.init();                     
  lcd.backlight();
  // lcdX.init();                     
  // lcdX.backlight();
  Serial.begin(115200); 
  pinMode(trigPin, OUTPUT); 
  pinMode(echoPin, INPUT); 
  pinMode(trigPinX, OUTPUT); 
  pinMode(echoPinX, INPUT); 
  
  pinMode(LDR_PIN, INPUT);


}

void loop(){

  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);
  duration = pulseIn(echoPin, HIGH);

  distanceCm = duration * SOUND_SPEED/2;
  distanceInch = distanceCm * CM_TO_INCH;
  distanceCmT = PERSEN + distanceCm / 100 * distanceCm;
  distanceCmTB = duration * SOUND_SPEED/2;
 
  digitalWrite(trigPinX, LOW);
  delayMicroseconds(2);
  digitalWrite(trigPinX, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPinX, LOW);
  durationX = pulseIn(echoPinX, HIGH);

  distanceCmX = durationX * SOUND_SPEED/2;
  distanceInchX = distanceCmX * CM_TO_INCH;
  distanceCmTX = ((distanceCmX - 75)  * PERSEN) / 100;
 
  Serial.print("Distance (cm): ");
  Serial.println(distanceCmT);
  Serial.print("Distance (inch): ");
  Serial.println(distanceInch);

  Serial.print("Distance (cm): ");
  Serial.println(distanceCmTX);
  Serial.print("Distance (inch): ");
  Serial.println(distanceInchX);

  lcd.setCursor(0,0);
  lcd.print("ToAt");
  lcd.setCursor(0,1);
  lcd.print(distanceCmTX);
  lcd.print(" %");

  lcd.setCursor(6,0);
  lcd.print("buka");
  lcd.setCursor(6,1);
  lcd.print(distanceCmT);
  lcd.print(" lum");

  lcd.setCursor(0,2);
  lcd.print("ToBa");
  lcd.setCursor(0,3);
  lcd.print(distanceInch);
  lcd.print(" in");

  lcd.setCursor(9,2);
  lcd.print("TB");
  lcd.setCursor(9,3);
  lcd.print(distanceCmTB);
  lcd.print(" cm");

  //    if(distanceCmTB<25){ 
  // distanceCmTB = "75%";
  // } 
  // else if(distanceCmTB>=25 && distanceCmTB<50){
  // distanceCmTB = "50%";
  //   }
  // else{
  // distanceCmTB = "25%";
  //   }
  delay(50000);
  lcd.clear();
}