Added some debug to arduino version