Fixed dijkstra.cpp, sort should be done out side of loop.