#include <LiquidCrystal_I2C.h>

LiquidCrystal_I2C lcd(0x27,16,2);  // set the LCD address to 0x27 for a 16 chars and 2 line display
float duration, distance;
void setup()
{
  // Sensore
  Serial.begin(115200);
  pinMode(12, OUTPUT);
  pinMode(10, INPUT);
  pinMode(9, OUTPUT);
  pinMode(11, INPUT);
  digitalWrite(12, LOW);
  digitalWrite(9, HIGH);
  Serial.begin(9600);
  pinMode(13, OUTPUT);

  // Lcd 
  lcd.init();
  // Print a message to the LCD.
  lcd.backlight();
  lcd.setCursor(3,0);
  lcd.print("Hello, world!");
  lcd.setCursor(2,1);
  lcd.print("Ywrobot Arduino!");
}


void loop(){
  digitalWrite(10, LOW);
  delayMicroseconds(2);
  digitalWrite(10, HIGH);
  delayMicroseconds(2);
  digitalWrite(10, LOW);

  duration = pulseIn(11, HIGH);
  distance = (duration*0.0343)/2;
  Serial.print("Distance: ");
  Serial.println(distance);

  lcd.clear();
  lcd.setCursor(0,0);
  lcd.print("Udaljenost:");
  lcd.setCursor(0,1);
  lcd.print(distance);

  if (distance <= 1){
    digitalWrite(13, HIGH);
  } 
  if (distance <= 10) {
      digitalWrite(13, HIGH);
      delay(distance*500);
      digitalWrite(13, LOW);
  } 
  if (distance > 10) {
    digitalWrite(13, LOW);
  }
  }