Main Firmware update

Created a sketch in MPIDE. Basic command parsing works.