Add proper error handling when receiving a TC byte from usart

The current implementation gets the error type but there is no action following. Design and implement that.