Most of pathfinding done

Need to finish searching completed tree for exit
Also, add directed edges in tree to ignored list