POJ 1475 Pushing Boxes 嵌套BFS -

题目地址：http://poj.org/problem?id=1475

题意Push路程要最少，所以直接找box到T的最短路径

box能动的前提是有个man能直接在他后面推他

所以再加一个BFS找man到他后面的最短路径

然后思考要优选队列里要保存哪些信息

box在何处 这个肯定要

还要保存路径啊，题目求的就是这个，所以box从起点到该点路径要保存，那么直接放个Path字符串保存一下路径就好了

然后要求man到box屁股后面的路径，那必须要知道man原来在哪里对不对，所以再保存个man点

算法就是BFS box走一步时再BFS man看看能不能走

AC代码如下：

#include<cstdio>
#include<cstring>
#include<queue>
#include<string>
#include<algorithm>
#include<iostream>
using namespace std;
const int maxn=20+5;
int R,C;
char G[maxn][maxn];
struct Point{
int x,y;
Point(int x=0,int y=0):x(x),y(y){}
bool operator == (const Point& p){
return x==p.x&&y==p.y;
}
bool operator != (const Point& p){
return !(*this==p);
}
}box,terminal,start;
struct Node{
Point box;Point man;string path; //man保存此box时man的位置
Node(Point b,Point man,string p):box(b),man(man),path(p){}
Node(Point man,string p):man(man),path(p){}
};
const int dx[]={-1,1,0,0};
const int dy[]={0,0,-1,1};
const char d[]="NSWEnswe";
void Print(Point p){
cout<<p.x<<' '<<p.y<<endl;
}
Point move(Point p,int i){
return Point(p.x+dx[i],p.y+dy[i]);
}
bool inside(Point p){
return p.x>=1&&p.x<=R&&p.y>=1&&p.y<=C;
}
string BFS_MAN(Point s,Point t,Point box) //s->t 中间不能经过box
{
queue<Node> Q;
bool vis[maxn][maxn]={false};
Q.push(Node(s,""));
while(!Q.empty())
{
Point u=Q.front().man; string path=Q.front().path; Q.pop();
if(u==t) return path;
for(int i=0;i<4;i++)
{
Point v=move(u,i);
if(!inside(v)||G[v.x][v.y]=='#'||box==v||vis[v.x][v.y]) continue;
vis[v.x][v.y]=true;
Q.push(Node(v,path+d[i+4]));
}
}
return "";
}

bool BFS_BOX()
{
queue<Node> Q;
bool vis[maxn][maxn][4]={false};
Q.push(Node(box,start,""));
while(!Q.empty())
{
Point ubox=Q.front().box,uman=Q.front().man; string path=Q.front().path; Q.pop();
if(ubox==terminal) {
cout<<path<<endl;
return true;
}
for(int i=0;i<4;i++)
{
Point vbox=move(ubox,i);
if(!inside(vbox)||G[vbox.x][vbox.y]=='#'||vis[vbox.x][vbox.y][i]) continue;

Point vman=move(ubox,i^1);  //反方向走
if(!inside(vman)||G[vman.x][vman.y]=='#') continue;
string ManPath;
if(vman!=uman){
ManPath=BFS_MAN(uman,vman,ubox);
if(ManPath.empty()) continue;
}
vis[vbox.x][vbox.y][i]=true;
Q.push(Node(vbox,ubox,path+ManPath+d[i]));
}
}
return false;
}
int main()
{
int kase=0;
while(cin>>R>>C)
{
if(R==0&&C==0) break;
for(int i=1;i<=R;i++) {
cin>>(G[i]+1);
for(int j=1;j<=C;j++)
if(G[i][j]=='T') terminal=Point(i,j);
else if(G[i][j]=='B') box=Point(i,j);
else if(G[i][j]=='S') start=Point(i,j);
}
printf("Maze #%d\n",++kase);
if(!BFS_BOX()) cout<<"Impossible."<<endl;
cout<<endl;
}
return 0;
}