Add printf & sprintf function to support USART