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;
}