Keypad Controller Code - PIC16F1508