USART bug fix