Add USART send code