Reorganized Debugging Messages

Created debug message methods, shortening code. Changed baud rate to
serial terminal. Debug Variable used to turn on debug mode on or off.