Update Pathfinder.h