Removed SleepIfOkay() call, this might mess up the UART queue reading.