Debugging debugging and DEBUG_* macros.

Make debugging more useful on the Arduino.
Start cleaning up DEBUG_* macro logics to ease later removal.

Reviewed menu output code usage.