Pathfinder algorithm: Dijkstra