Fixed usart code. Works for commands that do not send a payload