Fixed bugs, got keypad working, menu system working via serial.