Successfully implemented pathfinding!