Added Debugging Toggle function and included DebugUtil.h file whith macro for debugging