Added debug macros, working on baud rate changes