(Debug) adding shortest_path which is currently in a broken state