bfs 迷宫输出最短路径

想法：用step[maxn][maxn]数组储存每个位置需要的最小步数
用dir[maxn][maxn]存储上个节点过来的方向，由于是bfs，到这个位置的时候如果步数最小，那么方向一定是唯一的。所以每个位置的dri只会被更新一次
还需要一个visit数组储存是否访问（也可以把map设置成false，因为一个地方被visit以后相当于这里就是墙了）

注意这里涉及到deque的使用，
deque有
push_back
,push_front,
pop_back,
pop_front,
back,
front方法

#include <iostream>#include <queue>#include <deque>using namespace std;int sx,sy,dx,dy;const int maxn=10005;bool visit[maxn][maxn];int dir[maxn][maxn];bool map[maxn][maxn];int step[maxn][maxn];int M,N;const int INF=999999;int tx[]={0,0,-1,1};int ty[]={-1,1,0,0};typedef struct{    int x,y;}Point;int bfs(int x,int y){    visit[x][y]=true;    queue<Point> Q;    Point cur;    cur.x=x,cur.y=y;    Q.push(cur);    while(!Q.empty()){        cur=Q.front();        Q.pop();        if(cur.x==dx&&cur.y==dy) return step[cur.x][cur.y];        Point next;        for(int i=0;i<4;i++){            next.x=cur.x+tx[i],next.y=cur.y+ty[i];            if(map[next.x][next.y]&&!visit[next.x][next.y]){                Q.push(next);                visit[next.x][next.y]=true;                dir[next.x][next.y]=i+1;                step[next.x][next.y]=step[cur.x][cur.y]+1;            }        }    }    return INF;}void print(int x,int y){    deque<Point> path;    Point next;    while(x!=sx||y!=sy){        next.x=x,next.y=y;        path.push_back(next);        if(dir[x][y]==1) y++;        else if(dir[x][y]==2) y--;        else if(dir[x][y]==3) x++;        else if(dir[x][y]==4) x--;        else return ;    }    next.x=sx,next.y=sy;    path.push_back(next);    while(!path.empty()){        next=path.back();        path.pop_back();        printf("(%d,%d)\n",next.x,next.y);    }}int main(int argc, char const *argv[]){    while(cin>>M>>N){        memset(map,false,sizeof(map));        memset(dir,0,sizeof(dir));        memset(visit,false,sizeof(visit));        for(int i=1;i<=M;i++){            for(int j=1;j<=N;j++){                cin>>map[i][j];            }        }        cin>>sx>>sy>>dx>>dy;        cout<<bfs(sx,sy)<<endl;;         print(dx,dy);        // for(int i=1;i<=M;i++){        //  for(int j=1;j<=N;j++){        //      cout<<dir[i][j]<<" ";        //  }        //  cout<<endl;        // }        // cout<<endl;        // for(int i=1;i<=M;i++){        //  for(int j=1;j<=N;j++){        //      cout<<map[i][j]<<" ";        //  }        //  cout<<endl;        // }        // cout<<endl;        // for(int i=1;i<=M;i++){        //  for(int j=1;j<=N;j++){        //      cout<<step[i][j]<<" ";        //  }        //  cout<<endl;        // }        // cout<<endl;    }    /* code */    return 0;}