Update to pathfinding test