Arduino - Mjerenje brzine

  // MJERENJE BRZINE BICIKLA
  if(_kocnica_l > 700)
  {
      if(_brzina_uhvatio == false)
      {
          _brzina_puta++;
          _brzina_uhvatio = true;
          if(_brzina_puta == 1) _brzina_vrijeme = _vrijeme;
      }
  }
  else _brzina_uhvatio = false;

  if(_vrijeme - _brzina_vrijeme >= 1000 && _brzina_vrijeme != 0)
  {
      char _tekst[9];

      display.setCursor(0, 0);
      display.setTextSize(2);
      sprintf(_tekst, "%.02d km/h ", int(floor(float(_brzina_puta) * _PROMIJER_KOTACA * 3.60)));
      display.println(_tekst);
      Serial.println(int(floor(float(_brzina_puta) * _PROMIJER_KOTACA * 3.60)));

      _brzina_vrijeme = 0;
      _brzina_puta = 0;
      _brzina_uhvatio = false;
      _aktivan_vrijeme = _vrijeme;
  }