Updates to Pathfinder

Implementation of the build methods inside of PathFinder