Arduino - Miernik odległości, LCD i dioda

#define rled 13
#include <Wire.h>
#include <LiquidCrystal_I2C.h>
LiquidCrystal_I2C lcd(0x3F, 2, 1, 0, 4, 5, 6, 7, 3, POSITIVE);
int Trig = 2;
int Echo = 3;
int CM;
long CZAS;
int n=0;

void setup()
{
  pinMode(rled, INPUT_PULLUP);
  pinMode(Trig, OUTPUT);
  pinMode(Echo, INPUT);
  wyswietlacz();
}

void loop()
{
  lcd.clear();
  n++;
  pomiar();
  digitalWrite(rled, HIGH);
  delay(100);
  digitalWrite(rled, LOW);
  lcd.print("proba: ");
  lcd.print(n);
  lcd.setCursor(0,1);
  lcd.print("odleglosc: ");
  lcd.print(CM);
  lcd.print("cm");
  delay(10000);
}

void wyswietlacz()
{
  lcd.begin(16,2);
  for(int i=0;i<3;i++)
  {
    lcd.backlight();
    delay(100);
    lcd.noBacklight();
    delay(100);
  }
  lcd.backlight();
  lcd.display();
  lcd.setCursor(0,0);
}

void pomiar()
{
digitalWrite(Trig, LOW);
delayMicroseconds(2);
digitalWrite(Trig, HIGH);
delayMicroseconds(15);
digitalWrite(Trig, LOW);
digitalWrite(Echo, HIGH);
CZAS = pulseIn(Echo, HIGH);
CM = CZAS/58;
}