First commit of working arduino sketch