Possible final version, still has hacked UART