#include <afstandssensor.h>
#include <LCD_I2C.h>
LCD_I2C lcd(0x27, 16, 2);
int distancia;
AfstandsSensor afstandssensor(2, 3);  // Starter afstandssensoren på ben 13 og 12.

void setup () {
    Serial.begin(9600);  //
    	// initialize the LCD
	lcd.begin();


	lcd.backlight();
	
}

void loop () {
  lcd.setCursor(0,0);
  lcd.print("SENAI 2024");
    //delay(2000);
    //lcd.clear();
   distancia = afstandssensor.afstandCM();
   lcd.setCursor(0, 1);
   lcd.print(distancia);
   

//delay(2000)
//lcd.clear();

    //Serial.println(afstandssensor.afstandCM());
    //delay(500);
}