Adding pathfinding test