Fixed GreedyPathFinder bug
Fix the tests