First implementation of Pathfinder