Add first version of arduino code