fixed the iterators so const iterators properly work now too
got the pathfinding fully working, at least for unweighted graphs with no specific direction rules