Working dijkstras algorithm with debug comments -MCM