Added debug routines to identify issues.
Added test routines for sanity checking UART library
Added print statement to identify execution bug