Fix the race condition on USART Tx