Ported most of code to new board, still need delay and EEPROM functions