Implementation of Dijsktra's Algorithm in C++