Pull request for SelectBestPath() changes in PathFinderController