Minor refactoring and comments in code.
More commenting
Begins to implement Dijkstra for graph.