Test actual topological sort orders are correct
Add some Dijkstra path functionality