Adding first version of code
Allows to compile and flash easily