Correção de bugs no robot state. Não tava chamando as funções para ler parametros e conexão com topicos e serviços