utils.py 文件源码

def astar_len(graph, width, height, startx, starty, targetx, targety):
    adj = adjecent_2DGridWorld(graph, width, height)
    G = nx.from_numpy_matrix(adj)
    return nx.astar_path_length(G, starty*width+startx, targety*width+targetx)