Partially Implemented PathFinder.cpp