Optimizando o algoritimo, implementando Grafo Não Dirigido