Made FindPath return only the path not the closelist