#include <LiquidCrystal.h>
#include <stdio.h>
#define PIN_TRIG 3
#define PIN_ECHO 2

LiquidCrystal lcd(12, 11, 10, 9, 8, 7);

void setup() {
  // LCD Screen set up
  lcd.begin(16, 2); //LCD Screen size
  // LCD Interaction
  lcd.print("Booting up...");
  

  // Ultrasonic sensor set up
  pinMode(PIN_TRIG, OUTPUT);
  pinMode(PIN_ECHO, INPUT);
}

void loop() {

  // Clear Screen
  lcd.clear();
  lcd.setCursor(0, 0);

  // Ultra Sound Emission
  digitalWrite(PIN_TRIG, HIGH);
  delayMicroseconds(10);
  digitalWrite(PIN_TRIG, LOW);



  // Measurement
  int bounce = pulseIn(PIN_ECHO, HIGH);
  if (bounce != 0) {
    int distance = bounce / 58;
    char buffer[50];
    sprintf(buffer, "Distance: %d", distance);
    lcd.print(buffer);
  }
  else{
    //lcd.print("Error no measurement");
    lcd.print("Measurement Error");
  }

  delay(5000);
}