Debug code, changes in arduino sketch