Finally worked out pathfinding

currently only in the 2nd room