Build a logical system for enabling debug printing.

[Nate711]

It would be nice to add certain serial commands that would enable certain groups of print statements, or at least add a better system of using #define DEBUG.