Algoritmo de Encolar funcionando