Completed State machine, tested UART