poj 1475 Pushing Boxes（推箱子游戏，bfs+bfs）

算法思想：

对箱子进行bfs，每移动一次就 对人bfs一次，看能否走到箱子的后面，能走到就加入队列。

个人认为有点繁琐的地方就是路径的保存。

还有，每个case后有一个\n,不然会WA……

#include<cstring>#include<algorithm>#include<queue>#include<cstdio>#include<stack>using namespace std;struct node{  int x,y;  int px,py;  int d;};int tx,ty;int n,m;int dx[]={-1,1,0,0};int dy[]={0,0,-1,1};int ax[]={1,-1,0,0};int ay[]={0,0,1,-1};char word[]={'n','s','w','e'};int cas;char visb[25][25][4];char visp[25][25];stack<char> ans[10000];int map[25][25];int fa[10000];int head,tail;int pre[10000];char path[10000];bool okmap(int x,int y){    return x>=0&&x<n&&y>=0&&y<m&&map[x][y];}bool okgo(int x,int y,int tarx,int tary,int dir){    if(x==tarx&&y==tary)    {        ans[tail].push(word[dir]-32);        return true;    }    queue<node> q;    node front;    front.px=x;    front.py=y;    q.push(front);    node rear;    pre[0]=-1;    int f=0,e=1;    while(!q.empty())    {        front=q.front();q.pop();        for(int d=0;d<4;d++)        {            rear.px=front.px+dx[d];            rear.py=front.py+dy[d];            if(okmap(rear.px,rear.py)&&!visp[rear.px][rear.py])            {                visp[rear.px][rear.py]=1;                pre[e]=f;                path[e]=word[d];                if(rear.px==tarx&&rear.py==tary)                {                    ans[tail].push(word[dir]-32);                    while(e)                    {                        ans[tail].push(path[e]);                        e=pre[e];                    }                    return true;                }                e++;                q.push(rear);            }        }        f++;    }    return false;}void print(int k){    if(k==0) return;    print(fa[k]);    while(!ans[k].empty())    {        putchar(ans[k].top());        ans[k].pop();    }}void bfs(int x,int y,int px,int py){    node front;    front.x=x;front.px=px;    front.y=y;front.py=py;    queue<node> q;    q.push(front);    node rear;    head=0,tail=1;    while(!q.empty())    {        front=q.front();q.pop();     //   printf("箱x=%d,y=%d人:x=%d,y=%d\n",front.x,front.y,front.px,front.py);        for(int d=0;d<4;d++)        {            rear.x=front.x+dx[d];            rear.y=front.y+dy[d];            int lx=front.x+ax[d];   //反方向            int ly=front.y+ay[d];            if(okmap(rear.x,rear.y)&&okmap(lx,ly)&&!visb[rear.x][rear.y][d])            {              memset(visp,0,sizeof(visp));                visp[front.x][front.y]=1;                visp[front.px][front.py]=1;                fa[tail]=head;                if(okgo(front.px,front.py,lx,ly,d))                {visb[rear.x][rear.y][d]=1;                    rear.d=d;                    rear.px=front.x;                    rear.py=front.y;                    if(rear.x==tx&&rear.y==ty)                    {                        print(tail);                        return;                    }                    tail++;                    q.push(rear);                }            }        }        head++;    }    printf("Impossible.");}int main(){    int bx,by,px,py;    char a[30];    cas=1;    while(scanf("%d%d",&n,&m)!=EOF)    {        if(!n&&!m) break;        memset(visb,0,sizeof(visb));        memset(map,0,sizeof(map));        for(int i=0;i<10000;i++)            while(!ans[i].empty())                ans[i].pop();        for(int i=0;i<n;i++)        {            scanf("%s",a);            for(int j=0;j<m;j++)            {                if(a[j]=='#') map[i][j]=0;                else map[i][j]=1;                if(a[j]=='T')                {                    tx=i;ty=j;                }                else if(a[j]=='B')                {                    bx=i;by=j;                }                else if(a[j]=='S')                {                    px=i;py=j;                }            }        }        printf("Maze #%d\n",cas++);        bfs(bx,by,px,py);        putchar(10);        putchar(10);    }    return 0;}