FindShortestPath fully functional.