Энкодер, алгоритм обработки сигнала Опции

[RicLab]

Добрый день.
Алгоритм обработки энкодера взял здесь.
Переделал для CVAVR, но заставить работать не получается.
К порту B подключены светодиоды, сигналы энкодера A и B подключены к порту D 2 и 3 соответственно.

Код

Chip type           : ATtiny2313
Clock frequency     : 8,000000 MHz
Memory model        : Tiny
External SRAM size  : 0
Data Stack size     : 32
*****************************************************/

#include <tiny2313.h>

int New;                   // новое значение состояния энкодера
unsigned char  EncData;    // счётный регистр энкодера
int EncState;              // предыдущее состояние энкодера


void EncoderScan(void)
{  

New=PIND&0xC;              // копируем в New состояние входов 2,3

switch (EncState)          // сравниваем текущее значение New со старым смотря в какую сторону вращение изменениям EncData ++ или --  
  {
case 2:
      {
      if (New==3) EncData++;  
      if (New==0) EncData--;  
      break;
      }
case 0:
      {
      if (New==2) EncData++;
      if (New==1) EncData--;  
      break;
      }
case 1:
      {
      if (New==0) EncData++;
      if (New==3) EncData--;
      break;
      }
case 3:
      {
      if (New==1) EncData++;
      if (New==2) EncData--;
      break;
      }  
  }
  
EncState=New;           // записываем новое значение предыдущего состояния

}
// Timer 0 overflow interrupt service routine
interrupt [TIM0_OVF] void timer0_ovf_isr(void)
{  
EncoderScan();         // запускаем функцию сканирования энкодера  
}

// Declare your global variables here

void main(void)
{
// Declare your local variables here

// Crystal Oscillator division factor: 1
#pragma optsize-
CLKPR=0x80;
CLKPR=0x00;
#ifdef _OPTIMIZE_SIZE_
#pragma optsize+
#endif

// Port B initialization
// Func7=Out Func6=Out Func5=Out Func4=Out Func3=Out Func2=Out Func1=Out Func0=Out
// State7=0 State6=0 State5=0 State4=0 State3=0 State2=0 State1=0 State0=0
PORTB=0x00;
DDRB=0xFF;

// Port D initialization
// Func6=In Func5=In Func4=In Func3=In Func2=In Func1=In Func0=In
// State6=P State5=P State4=P State3=P State2=P State1=P State0=P
PORTD=0x7F;
DDRD=0x00;

// Timer/Counter 0 initialization
// Clock source: System Clock
// Clock value: 1000,000 kHz
// Mode: Normal top=FFh
// OC0A output: Disconnected
// OC0B output: Disconnected
TCCR0A=0x00;
TCCR0B=0x02;
TCNT0=0x00;
OCR0A=0x00;
OCR0B=0x00;

// Timer(s)/Counter(s) Interrupt(s) initialization
TIMSK=0x02;

// Global enable interrupts
#asm("sei")

while (1)
      {
      PORTB=EncData;
    
      };
}

Где моё упущение?