Added some test code to the main file and made some changes to the Usart_Read function.