Create AStarPathFinder