Implemented Dijkstra (comments left)

-Fully commented commit.

Next improvements: remove the source node from the route probably,
remove the comments, make a separate method to handle the route array.