POJ 3984 迷宫问题 （bfs 水）

#include "string"
#include "iostream"
#include "cstdio"
#include "cmath"
#include "set"
#include "queue"
#include "vector"
#include "cctype"
#include "sstream"
#include "cstdlib"
#include "cstring"
#include "stack"
#include "ctime"
#include "algorithm"
#define pa pair<int,int>
#define Pi M_PI
#define INF 0x3f3f3f3f
#define INFL 0x3f3f3f3f3f3f3f3fLL
using namespace std;
typedef long long LL;
const int M=55;

int mp[5][5];
int dir[4][2]={1,0,-1,0,0,-1,0,1};
int vis[5][5];

struct node
{
    int x;
    int y;

}st,sd;



void bfs()
{
    queue<node>q;
    node ss;
    ss.x=0;
    ss.y=0;

    q.push(ss);
    while(!q.empty())
    {
       // q.pop();
       st=q.front();
       q.pop();
       //printf("(%d, %d)\n",st.x,st.y);
       if(st.x==4&&st.y==4)
        return ;


       for(int i=0;i<4;++i)
        {
            int xx=st.x+dir[i][0];
            int yy=st.y+dir[i][1];

            if(xx>=0 &&xx<5 &&yy>=0&&yy<5 &&mp[xx][yy]!=1&&vis[xx][yy]==-1)
            {
               // printf("(%d, %d)\n",xx,yy);
                sd.x=xx;
                sd.y=yy;
                vis[xx][yy]=vis[st.x][st.y]+1;
                q.push(sd);
            }




        }

    }




}

void print(int x,int y)
{
    if(!x&& !y)
    {
         printf("(0, 0)\n");
         return ;
    }


    for(int i=0;i<4;++i)
    {
        int xx=x+dir[i][0];
        int yy=y+dir[i][1];
        if(xx>=0 &&xx<5 &&yy>=0&&yy<5 &&vis[xx][yy]==vis[x][y]-1)
        {
            print(xx,yy);
            printf("(%d, %d)\n",x,y);
            return ;
        }

    }


}



int main()
{
    for(int i=0;i<5;++i)
        for(int j=0;j<5;++j)
    {
        cin>>mp[i][j];

    }
//    while(!q.empty())
//    {
//        q.pop();
//    }
    memset(vis,-1,sizeof(vis));

    vis[0][0]=0;
    bfs();
    //int a,b;
    //a=b=4;
    //printf("%d\n",vis[4][4]);
    print(4,4);
   // printf("(4, 4)\n");



    return 0;


}