Add debug logging to new Arduino Code