czujnik odległości

#define gled 13
int Trig = 2;
int Echo = 3;
int CM;
long CZAS;
#include <Wire.h>

void setup()
{
  pinMode(gled, OUTPUT);
  Serial.begin(9600);                                           //czujnik odleglosci podłączony pod serial port
  pinMode(Trig, OUTPUT);
  pinMode(Echo, INPUT);
  delay(100);

}

void loop() //pętla główna
{
  pomiar();
  if(CM>50)
  {
    digitalWrite(gled, LOW);
  }
  else if(CM>25 && CM<50)
  {
    digitalWrite(gled, HIGH);
  }
  else if(CM<25 && CM>10)
  {
    digitalWrite(gled, HIGH);
    delay(500);
    digitalWrite(gled, LOW);
    delay(500);
  }
  else if(CM<10)
  {
    digitalWrite(gled, HIGH);
    delay(100);
    digitalWrite(gled, LOW);
    delay(100);
  }
  Serial.println(CM);
}

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;
}