Fixed code to work with UART on Richards Raspberry