Спидометр для роллерсерфа

Скетч прошивки ATMega168A:
/*
* Mega168!!!
*/
#include"timer-api.h"

int Polarity = -1;//полярность импульса входного сигнала (в моем случае отрицательная
int Treshold = 500;//порог срабатывания формирователя отсчетного импулься 1/2 Vcc = 512
int CountTurn = 0; //хранение кол-ва оборотов за счетный период
int LED = 13; // LED подключен к PB5 пину
int InputSignal = A5; //вход для датчика Холла
int TurnNumber = 0; //накапливаемое количество оборотов
int DeltaT = 28; //задержка от фронта до определения окончания импульса для устойчивости
bool Tick = false; //начальное значение, тика еще не было

void setup()
{
Serial.begin(9600); //для отладки
timer_init_ISR_2Hz(TIMER_DEFAULT);//получается 1-сек задержка!!!
pinMode(LED, OUTPUT); //выход сигнала на подсветку (фару)
pinMode(InputSignal, INPUT); //вход для датчика Холла
}

void loop() // здесь делаем обработку сигналов с датчика и управления фарой
{
if (Tick) //разрешение исполнения блока if через фиксированный временной интервал
//отсылка кол-ва оборотов
{
Serial.println(String(CountTurn) + ";");//для отладки
Tick = false;//готовим след. интервал времени
CountTurn = 0; // обнуляем кол-во оборотов после передачи в смартфон
}

else //если тик еще не пришел - накапливаем кол-во оборотов, включаем/выключаем фару
{
//накопление кол-ва оборотов
if(analogRead(InputSignal) < Treshold)//передний фронт пришел
{
delay(DeltaT);//пока не читаем ничего
if(analogRead(InputSignal) > Treshold)//задний фронт пришел
{
CountTurn++; //накапливаем кол-во оборотов по приходу заднего фронта
}
}

//управление фарой
if (Serial.available() > 0)//читаем символ из BTSerial
{
char command = Serial.read();
switch(command)
{
case '0': digitalWrite(LED, LOW); break;//включаем фару
case '1': digitalWrite(LED, HIGH); break;//вЫключаем фару
}
}
}
}

void timer_handle_interrupts(int timer)
{
Tick = true;
}