网格中两点之间的路由

时间:2012-05-03 22:05:01

标签: algorithm graph graph-algorithm

给定一个点网格,我试图找到其中两个之间的路径。

就像在这张图片中一样:我需要找到黄线的点数:

enter image description here

我可以使用哪种最佳方法/算法?

由于

3 个答案:

答案 0 :(得分:3)

查看A* algorithm

它是许多视频游戏中用于寻路问题的东西,并且可以构建得非常强大。

答案 1 :(得分:1)

Dijkstra的算法可以是一个好的开始。

答案 2 :(得分:0)

你还没有确切地定义你想如何使用对角线,所以你必须根据需要编写最终函数,我想采用最短长度的路径使用对角线,注意来自>的路径。对于路径

中的a,b,c,c短于路径a> b> c
grid = [[False]*16 for i in range(16)]
#mark grid of walls

def rect(p1,p2):
    x1, y1 = p1
    x2, y2 = p2
    for x in range(x1, x2+1):
        for y in range(y1, y2+1):
            yield (x, y)

rects = [((1,2),(5,5)),
    ((5,5),(14,15)),
    ((11,5),(11,11)),
    ((5,11),(11,11)),
    ((4,7),(5,13)),
    ((5,13),(13,13))]

for p1,p2 in rects:
    for point in rect(p1,p2):
        x,y = point
        grid[x][y] = True

start = (1,2)
end = (12,13)

assert(grid[start[0]][start[1]])
assert(grid[end[0]][end[1]])

def children(parent):
    x,y = parent
    surrounding_points = ((x1,y1) for x1 in range(x-1,x+2) for y1 in range(y-1,y+2) if x1>0 and y<15)
    for x,y in surrounding_points:
        if grid[x][y]:
            #not a wall
            grid[x][y] = False
            #set as wall since we have been there already
            yield x,y

path = {}
def bfs(fringe):
    if end in fringe:
        return

    new_fringe = []
    for parent in fringe:
        for child in children(parent):
            path[child] = parent
            new_fringe.append(child)
    del fringe
    if new_fringe:
        bfs(new_fringe)

bfs([start])
def unroll_path(node):
    if node != start:
        return unroll_path(path[node]) + [node]
    else:
        return [start]

path = unroll_path(end)

def get_final_path_length(path):
    #return length of path if using straight lines
    for i in range(len(path)):
        for j in range(i+1,len(path)):
            #if straight line between pathi and pathj
            return get_final_path(path[j+1:]) + distance_between_i_and_j