Update ShortestPath.cpp