Adding debugging (need to figure out how to enable / disable in Arduino / MPIDE easily.

Updated UART open to make it easier to add support for more UARTS (still only one UART supports ATM).