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

#define TRIGGER_PIN  12  // ESP32 Pin connected to HC-SR04 trigger pin
#define ECHO_PIN     14  // ESP32 Pin connected to HC-SR04 echo pin
#define MAX_DISTANCE 405 // Maximum distance for HC-SR04

#define KALIBRIERUNGSKONSTANTE 0.97 // Diesen Wert müssen Sie durch Kalibrierung bestimmen

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); // NewPing setup
LiquidCrystal_I2C lcd(0x27,16,2);  // LCD setup, adjust the parameters for your display

float kalibrieren(float gemessenerAbstand) {
  float kalibrierterAbstand = gemessenerAbstand * KALIBRIERUNGSKONSTANTE;
  return kalibrierterAbstand;
}

void setup() {
  lcd.init(); 
  lcd.backlight();
}

void loop() {
  delay(50);                      // Wait 50ms between pings
  float gemessenerAbstand = sonar.ping_cm(); // Measure distance
  float kalibrierterAbstand = kalibrieren(gemessenerAbstand); // Calibrate distance

  lcd.clear(); 
  lcd.setCursor(0,0); 
  lcd.print("Abstand: ");
  lcd.print(kalibrierterAbstand);
  lcd.print(" cm");
}