Cleaned up Teensy Code. Commented out commands not used in project.
Set response strings to always print a copy to Serial(regardless of where UART is defined to go).
Fixed bug where incoming messages were echoed to the output.