Improved PathFinder, added PathFinder constructor