Added some UART testing code
Milestone one probably complete