Распознавание RFID

#define sbi(reg,bit) (reg |= (1<<bit))
#define cbi(reg,bit) (reg &= ~(1<<bit))
#define ibi(reg,bit) (reg ^= (1<<bit))
#define CheckByt(reg,bit) (reg&(1<<bit))
 
#define   SIT_CAPT_ON(l)   {l ? sbi(TCCR1B, ICES1) : cbi(TCCR1B, ICES1);}
#define CAPT_ON (CheckByt(TCCR1B, ICES1))
 
#define   SIT_COMP_INTERRUPT_ENABLED(l)   {l ? sbi(TIMSK, OCIE1A) : cbi(TIMSK, OCIE1A);}
 
void RFID_Init(void)
{
cbi(DDRB, 0); cbi(PORTB, 0);   // icp to input
 
RFID.bcounter = 0;
RFID.receiving = false;
RFID.period = 0;
RFID.haveData = false;
 
SIT_COMP_INTERRUPT_ENABLED(0);
OCR1A = 0;
 
//Если ICESn =0, то падающий фронт приводит к захвату,  ICESn = 1, то нарастающий фронт.
TCCR1B = _BV(ICNC1) | _BV(CS10);
SIT_CAPT_ON(0);
TIMSK |= _BV(TICIE1);
 
SIT_CAPT_ON(1);   // включаем захват по наростающему. В результате, прерывание будет вызвано когда будет передана первая половина первого бита (1).
}
 
void RFID_Start(void)
{
RFID.bcounter = 0;
RFID.receiving = false;
RFID.period = 0;
RFID.haveData = false;
SIT_CAPT_ON(0);
}
 
ISR(TIMER1_CAPT_vect)
{
if (RFID.haveData) return;
 
volatile uint16_t   capture = ICR1;
 
if (!RFID.period) {
if (CAPT_ON) RFID.period = capture;   // save period
 
ibi(TCCR1B, ICES1); // capture on different level
return;
}
// период получен, первый бит теперь отсутствует, от стартовых остались только 8
 
itoa(RFID.period, RFID.buffer, 10);
RFID.bcounter = strlen(RFID.buffer);
RFID.haveData = trui;
}

prymtf("%lu%lu", var/1000000000, var%1000000000)

interrupt [TIM1_CAPT] void timer1_capt_isr(void)
{
    ICR1 = TCNT1;
    TCNT1 = 0x00;
    //TIFR |= 0x20;
    //tgl(TCCR1B,ICES1);
    if (TCCR1B == 0x42) {TCCR1B = 0x02; edge = 1;} else {TCCR1B = 0x42; edge = 0;}
    time = ICR1; 
}