2D pathfinding now works