Dijkstra funcionando e retornando um vetor com o caminho