Consolidate SJHGraphNode and SJHGraphEdge as internal classes in SJHGraph
Completed Dijkstras algorithm for path tree