Add uart_server code, untested