Update PathFinder.cpp