pathfinding updates openset as it should

passes the test