Опрос клавиатуры 3х4 и вывод нажатой кнопки AT90S8515

#define F_CPU 8000000UL //Частота процессора
#include <avr/io.h>
#include <util/delay.h>
#include <avr/pgmspace.h>
 
int row=0;
int cln=0;
int n;
unsigned char r0;
unsigned char KeyTable[12][1] PROGMEM= 
{ 
{ 0xf9 },
{ 0xa4 },
{ 0xb0 },
{ 0x99 },
{ 0x92 },
{ 0x82 },
{ 0xf8 },
{ 0x80 },
{ 0x90 },
{ 0x00 },
{ 0xc0 },
{ 0x00 }
};
 
int main()
{
 DDRD|=(0<<PD0)|(0<<PD1)|(0<<PD2)|(1<<PD4)|(1<<PD5)|(1<<PD6)|(1<<PD7);
 PORTD|=(1<<PD0)|(1<<PD1)|(1<<PD2);
 DDRC=0xff;
 PORTC=0x00;
 
 while(1)
 {
  stroka();
  if(PD0==1)
  {
   if(PD1==1)
   {
    if(PD2==1)
    {
     if(row==3) row=0;
     else row++;
    }
    else cln=2;
   }
   else cln=1;
  }
  else cln=0;
  num();
  FindKey();
  PORTC=r0;
 }
 return 0;
}
 
void stroka(void)
{
 if(row==0)PORTD|= (0<<PD4)|(1<<PD5)|(1<<PD6)|(1<<PD7);
 if(row==1)PORTD|= (1<<PD4)|(0<<PD5)|(1<<PD6)|(1<<PD7);
 if(row==2)PORTD|= (1<<PD4)|(1<<PD5)|(0<<PD6)|(1<<PD7);
 if(row==3)PORTD|= (1<<PD4)|(1<<PD5)|(1<<PD6)|(0<<PD7);
 return 0;
}
 
int num(void)
{
 n=(row*2)+cln;
 return 0;
}
 
void FindKey(void) 
{
  unsigned char index;
  for (index = 0; index < 12; index++) 
  {
    if (pgm_read_byte(&KeyTable [n][index]) == n) 
    {
      r0 = pgm_read_byte(&KeyTable [n][index]);
      return 1;
    }
  }
  return 0;
}