Still debuging shortest path.