使用优化的astar算法。