DFS路径发现障碍

时间:2016-09-17 04:19:14

标签: python artificial-intelligence depth-first-search

我有以下网格,我试图进入该网格中的1,障碍物显示为2.机器人按此顺序优先运动:向上,向右,向下,向左。起始位置旁边有一个*。

 0   0*  0
 0   2   0
 1   1   0

到目前为止,我所做的是将该网格的位置设置为图形形式,并且还按优先顺序从每个位置生成所有可能的移动。但我的问题是,当算法到达第二行的最后一部分时,它会陷入循环。我正在尝试实现某种循环检测器,所以我不会陷入那种循环。

我还应该提到,机器人可以通过不同的路径访问相同的位置两倍。所以到目前为止我所拥有的是:

def dfs(grid,start):

    #find the routes in U,R,D,L order
    height = len(grid)

    width = len(grid[0])

    routes = {(i, j) : [] for j in range(width) for i in range(height)}

    for row, col in routes.keys():
      # Left moves
     if col > 0: 
          routes[(row, col)].append((row , col - 1))
      # Down moves    
     if row < height - 1:
          routes[(row, col)].append(((row + 1, col)))
     # Right moves
     if col < width - 1: 
         routes[(row, col)].append(((row , col + 1)))
     # Up moves
     if row > 0:
         routes[(row, col)].append(((row - 1, col)))

  #find the blocked ones

   blocked = {(i,j) for j in range(width) for i in range(height) if grid[i][j] == 2}

   path = []

   stack = [start]

   while stack:
     node = stack.pop()

     if node not in blocked:
         path.append(node)
         stack = []
         for x in routes[node]:
             stack.extend([x])

  return path

其中

 grid = [[0, 0, 0], [0, 2, 0], [1, 1, 0]]
 start = (0,1)

手动执行此操作会显示路径应如下所示:右,下,下,左,右,上,上,左,左,下,下

关于如何实现探测器的任何建议都会很棒,我对AI和python都很陌生,而且我一整天都想弄明白这一点......谢谢

1 个答案:

答案 0 :(得分:0)

试试这个:

def dfs2(grid,pos,curr,height,width):
    x = pos[0]
    y = pos[1]    
    if grid[x][y]==1:
        print str(curr)
        return None
    elif grid[x][y] ==2:
        return None        
    last = curr[-1]    
    if x-1 >= 0 and last != 'DOWN':        
        curr.append('UP')
        dfs2(grid,(x-1,y),curr,height,width)
        curr.pop()
    if y+1 < width and last != 'LEFT':        
        curr.append('RIGHT')
        dfs2(grid,(x,y+1),curr,height,width)
        curr.pop()
    if x+1 < height and last != 'UP':
        curr.append('DOWN')
        dfs2(grid,(x+1,y),curr,height,width)
        curr.pop()
    if y-1>=0 and last != 'RIGHT':
        curr.append('LEFT')
        dfs2(grid,(x,y-1),curr,height,width)
        curr.pop()


def dfs(grid,pos):
    dfs2(grid,pos,['START'],len(grid),len(grid[0]))

########MAIN#########
#up, right, down, left
grid = [[0, 0, 0], [0, 2, 0], [1, 1, 0]]
start = (0,1)
print str(grid)
dfs(grid,start)

这是基于递归。根据问题中指定的顺序尝试移动到下一个位置,并将移动存储在列表中,该列表在到达目的地时打印