Changed to CMSIS USART