Change Debug Printing syntaxis

Use DEBUG_PRINT instead of Serial.print with empty definition in when no
debug needed