Arreglado el algoritmo del costo del camino