Arduino MEGA HC-SR04 + LCD 162 I2C

gistfile1.txt

#include <Wire.h> 
#include <LiquidCrystal_I2C.h>
#define TRIG 4
#define ECHO 5
LiquidCrystal_I2C lcd(0x3f,2,16);

void setup()
{
  
  pinMode(TRIG,OUTPUT);
  pinMode(ECHO,INPUT);
  lcd.init(); 
  lcd.backlight();
}
  float pomiar(){
  unsigned long czas;
  digitalWrite(TRIG,HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG,LOW);
  czas = pulseIn(ECHO,HIGH);
  return czas / 58.00; 
}

void loop()
  {  
  lcd.clear();
  lcd.setCursor(0,0);
  lcd.print("POMIAR=");
  lcd.setCursor(7,0);
  lcd.print(pomiar());
  lcd.setCursor(13,0);
  lcd.print("cm");
  delay(1000);
  }