用python写一个a*算法

好的，我可以回答这个问题。A*算法是一种启发式搜索算法，可以用于寻找最短路径。以下是一个简单的Python实现：

def astar(start, goal, graph):
    frontier = PriorityQueue()
    frontier.put(start, 0)
    came_from = {}
    cost_so_far = {}
    came_from[start] = None
    cost_so_far[start] = 0
    
    while not frontier.empty():
        current = frontier.get()
        
        if current == goal:
            break
        
        for next in graph.neighbors(current):
            new_cost = cost_so_far[current] + graph.cost(current, next)
            if next not in cost_so_far or new_cost < cost_so_far[next]:
                cost_so_far[next] = new_cost
                priority = new_cost + heuristic(goal, next)
                frontier.put(next, priority)
                came_from[next] = current
    
    return came_from, cost_so_far

其中，`start`和`goal`分别是起点和终点，`graph`是一个表示地图的对象，包含了节点和边的信息。`heuristic`函数是一个估价函数，用于评估从当前节点到终点的距离。在这个实现中，我们使用了优先队列来保存待扩展的节点，每次选择距离终点最近的节点进行扩展。