Made debug printing optional, changed mode pin

Replaced direct Serial.print*() functions with my own wrapper that
allowed calls to be flagged as needing a new line and being printed only
if a debug flag was set. Uses function overloading, but only for those
types I actually need.