USART fixes based on feedback from @ledvinap.