Задержка для нефиксирующей кнопки (PIC нонэйм)

(основной цикл)
{
   Проверить нажата ли кнопка
   (если нажата)
   {
      подождать 20 мс;
      Проверить нажата ли кнопка
      (если таки еще нажата)
      {
         Сказать программе "В натуре кнопка нажата"
      }
 
   }
}

while(1){
RA0=1;
__delay_ms(50);
RA0=0;
__delay_ms(50);
}

unsigned char key_on;
 
void TimerInterrupt()
{
  static unsigned char key_count = 0;
 
  if(key_port == 0)
   {
    key_count++;
      if(key_count == 4)
      {
        key_on = 1;
        key_count = 0;
      }
   } else
      {
        key_count = 0;
      }
}
 
void main()
{
  key_on = 0;
 
  while(1)
  {
    if(key_on == 1)
    {
      key_on = 0;
      //кнопка нажата делаем что то
    }
  }
}

while(1){
RA0=1;
__delay_ms(50);
RA0=0;
__delay_ms(50);
}

while(1){
RA0=1;
PR2=50 
T2CON=0b00000100
RA0=0;
PR2=50 
T2CON=0b00000100
}

void interrupt isr(void)
{
  if(T0IF)        //  при переполнение TMR0
   {
     T0IF=0;     //  сбрасываем флаг о его переполнение
      if(RA0==1)
        {
          RA0=0;
        }else
          {
            RA0=1;
          }
    }
}

void main()
{
INTCON=0b11100000;  //  Настройка прерываний
OPTION=0b00101000;  //  Настройка TMR0
while(1)
{
 
}
 
}