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

#define triggerPin1 13
#define echoPin1 12
#define triggerPin2 25
#define echoPin2 26
#define pb1 34
#define pb2 35

long durationx;
long durationy;
float jarakx, jarakx_z, jarakx_asli;
float jaraky, jaraky_z, jaraky_asli;
float kalibrasi1 = 0;
float kalibrasi2 = 0;


void setup()
{
  Serial.begin(115200);
  pinMode(triggerPin1, OUTPUT);
  pinMode(echoPin1, INPUT);
  pinMode(triggerPin2, OUTPUT);
  pinMode(echoPin2, INPUT);
  pinMode(pb1, INPUT_PULLUP);
  pinMode(pb2, INPUT_PULLUP);
}

void loop()
{
  digitalWrite(triggerPin1, LOW);  
  delayMicroseconds(2);      

  digitalWrite(triggerPin1, HIGH);  // Set triggerPin high
  delayMicroseconds(10);      // triggerPin high selama 10 micro seconds
  digitalWrite(triggerPin1, LOW);   // triggerPinPin low

  if (digitalRead(pb1) == LOW) {
  jarakx_z = jarakx;  
  }
  if (digitalRead(pb2) == LOW) {
  jaraky_z = jarakx;  
  }

  durationx = pulseIn(echoPin1, HIGH);   //Pembacaan Echo pin dan durasi
  jarakx = (durationx * 0.0034 / 2);
  jarakx_asli = jarakx - jarakx_z;   ///Menghitung jarak yg sebenarnya  ///Menghitung jarak yg sebenarnya

   

  digitalWrite(triggerPin2, HIGH);  // Set triggerPin high
  delayMicroseconds(10);      // triggerPin high selama 10 micro seconds
  digitalWrite(triggerPin2, LOW);   // triggerPinPin low

  durationy = pulseIn(echoPin2, HIGH);   //Pembacaan Echo pin dan durasi
  jaraky = (durationy * 0.0034 / 2);
  jaraky_asli = jaraky - jaraky_z;   ///Menghitung jarak yg sebenarnya



  lcd.setCursor(0, 0);
  lcd.print("Jarak Titik X : " );
  lcd.print(jarakx);
  lcd.print(" mm");
  lcd.setCursor(0, 0);
  lcd.print("Jarak Titik Y : " );
  lcd.print(jaraky);
  lcd.print(" mm");

  delay(250);
}