Using UART code from KC705_experimental, take 2