Add initial version of the firmware, copied from the prototype project and partially ported for the processor on the board