[Help] Keypad 4x4

[lee_trieu]

Chào mọi người !!
Cho em hỏi chút về việc quét bàn phím hex với msp430.

Em kết nối phần cứng như thế này

Em viết code như thế này

#include "msp430f2122.h"
#define read (P1IN & 0x0F)


int scan_code[4]={0xE0,0xD0,0xB0,0x70};
int keyin[4]={0xfE,0xfD,0xfB,0xf7};
int key[4][4]={1,2,3,4,5,6,7,8,9,0,10,12,13,14,15};
int c=0,r=0,i,j;
int checkkey(void);
void conf_clock(void)
{
   if (CALBC1_1MHZ ==0xFF || CALDCO_1MHZ == 0xFF)                                     
  {  
    while(1);                               // If calibration constants erased
                                            // do not load, trap CPU!!
  }
  BCSCTL1 = CALBC1_1MHZ; //calibration clock - (1MHz , 8MHz, 12MHz, or 16MHz)
  DCOCTL = CALDCO_1MHZ;   
  
}
void conf_timer(void)
{
  CCTL0 = CCIE;                             // CCR0 interrupt enabled
  CCR0 = 50000;
  TACTL = TASSEL_2 + MC_1;                  // SMCLK, contmode
  _BIS_SR( GIE);                 // Enter LPM0 w/ interrupt
}
void main( void )
{
  // Stop watchdog timer to prevent time out reset
  WDTCTL = WDTPW + WDTHOLD;
  conf_clock();
  //conf_timer();
  P1DIR |= 0xf0;
  P2DIR |= 0xff;
  P3DIR |= 0xff;


  while(1)
  {
  P1OUT |= 0xf0; //giu 4 cot o muc cao
  checkkey();
  if(key[r][c]==5)//gia su phim 5 duoc an 
  {
    P3OUT ^=BIT0;   //thi cho LED nhay
    __delay_cycles(100000);
   
  }
  }
 
}


int checkkey()
{
  if(read != 0x0F) //Neu co nut nhan
  {
    for(i=0;i<4;i++)//quet cot(Lan luot keo 4 cot xuong thap)
    {
      P1OUT = scan_code[i];
      for(j=0;j<4;j++)//quet hang
      {
        if(read==keyin[j])// Neu bang 
        {
        c=i;
        r=j;
        
        }
      }
    }
  }
  return key[r][c];
}

Mọi người xem giúp em code lỗi chỗ nào mà em làm hoài nó vẫn không chạymất mấy ngày rồi em làm vẫn không ra !! Mọi người vào giúp em với ! Em cảm ơn !!