db kb_chars "0,1,2,3,4,5,6,7,8,9,A,B,C,D,*,#"

db  valid_btns "1,2,4,5,8"

const unsigned char key_code[16]={0x30,0x31,0x32,0x33,0x34,0x35,0x36,0x37,
                                    0x38,0x39,0x41,0x42,0x43,0x44,0x2A,0x23};

unsigned char key_ascII(unsigned char key_nomb){
            return key_code[key_nomb];
}

key_ascII:
movfw key_nmb
addwf PCL,f
retlw    0x30
retlw    0x31
retlw    0x32
retlw    0x33
retlw    0x34
retlw    0x35
retlw    0x36
retlw    0x37
retlw    0x38
retlw    0x39
retlw    0x41
retlw    0x42
retlw    0x43
retlw    0x44
retlw    0x2A
retlw    0x23

unsigned char button_ticks[16];
unsigned int btns_pressed;

const unsigned char Key[]=
   { KEY_7, KEY_8, KEY_9, KEY_0, KEY_1, KEY_2, KEY_3,KEY_UP, KEY_OK,
     KEY_F1, KEY_C, KEY_NO, KEY_4, KEY_5, KEY_6, KEY_DOWN};

void Keyboard_task(void)
{
   unsigned char col,pos;
      unsigned char all_released = 1;
   unsigned int mask, new_keys;


   PIN_IDIS(KEYREAD);      //disable keyboard pin interrupts
   PIN_CLEAR(KEYDRIVE);   //drive all to 0 to discharge parasitic caps
   PIN_DIR_IN(KEYDRIVE);   //disconnect all drive pins
   
   mask = 0x10;
   for(col = 0; col<4; col++)
   {

      KEYDRIVE_P.out |= mask;   //Set one drive pin at 1
        KEYDRIVE_P.dir |= mask;
      

        new_keys <<= 4;
        new_keys |= PIN_IN(KEYREAD);

      PIN_CLEAR(KEYDRIVE);
      PIN_DIR_IN(KEYDRIVE);

        mask<<=1;
    }

   
    mask = 0x8000;
    for(pos=0;pos < 16; pos++)
   {
      if (mask & new_keys)
      {//button pressed
            all_released = 0;
         button_ticks[pos]++;
         if(mask & btns_pressed)
         { //button hold?
            if (button_ticks[pos] > REPEAT_TIME)
            {
               button_ticks[pos] = 0;
               post_key_code(KEY_REPEAT, Key[pos]);
            }
         } else
            if (button_ticks[pos] > PRESS_TIME)
            {
               button_ticks[pos] = 0;
               btns_pressed |= mask;
            post_key_code(KEY_PRESSED, Key[pos]);
            }
         
      } else
      {
         button_ticks[pos] = 0;
            if (mask & btns_pressed)
            {
               btns_pressed &= ~mask;
      
            post_key_code(KEY_RELEASED, Key[pos]);
            }
      }
      
        mask >>=1;
   }

   if(all_released)
   {
      PIN_CLR_EVENT(KEYREAD);   
      PIN_IE(KEYREAD);
      PIN_OUT_1(KEYDRIVE);
   }

}