#define debug added

Added flag controllable debug statements using header macros. Can save a
2k when all statements are disabled. Working as a proof of concept.
Still need to work on what statements are at which level. Still need to
tidy up code.