Speed up the receving part and fix USART rx problem