redução nos passos da maquina de estado. melhoria na consulta do angulo
Agora retorna o número do indice do servo consultado para que se possa
enviar dezenas de consultas consecultivas