fixed bugs in polygon_path_finder for finding nearest points
Merge pull request #1014 from romulox-x/pathFinderBugs

fixed bugs in polygon_path_finder for finding nearest points