POJ 3984

通过BFS解决迷宫问题，再利用一个last[]数组由出口倒置回来不断找到上一个点的位置，最终返回入口，而得到这条最短路径

代码:

#include<iostream>
#include<string.h>
#include<queue>

using namespace std;

int map[5][5];
int dir[4][2]={{-1,0},{1,0},{0,-1},{0,1}};
int visit[5][5]={0};
int last[25];
int ans[25];//用last得到的最短路径是倒置的，通过last再倒回来；

struct Node{
    int x,y;
    int logo;
}node[25];

int main()
{
    for(int i=0;i<5;i++)
    {
        for(int j=0;j<5;j++)
        {
            cin>>map[i][j];
            node[5*i+j].x=i;
            node[5*i+j].y=j;
            node[5*i+j].logo=map[i][j];
        }
    }

    queue<Node> Q;

    Q.push(node[0]);

    while(!Q.empty()){
        Node a=Q.front();
        visit[a.x][a.y]=1;
        //cout<<a.x<<'	'<<a.y<<endl;
        Q.pop();
        for(int i=0;i<4;i++)
        {
            Node next;
            next.x=a.x+dir[i][0];
            next.y=a.y+dir[i][1];
            next.logo=node[5*next.x+next.y].logo;
            if(next.x>=0&&next.x<5&&next.y>=0&&next.y<5&&next.logo==0&&visit[next.x][next.y]==0)
            {
                Q.push(next);
                last[next.x*5+next.y]=a.x*5+a.y;//last得到上一个节点的位置所在
            }
        }
    }

    int p=24,top=0;
    while(true)
    {
        ans[top++]=p;
        if(p==0) break;
        p=last[p];
    }

    while(top>0)
    {
        --top;
         cout<<"("<<ans[top]/5<<", "<<ans[top]%5<<")"<<endl;
    }

    return 0;
}