hdu1026 迷宫王子救公主 BFS+优先队列

//简单BFS，保存路径 有点麻烦
#include<stdio.h>
#include<string.h>
#include<queue>
using namespace  std;


struct  node
{
int x,y,step;
friend bool operator<(node n1,node n2)//优先队列 
{
return n2.step<n1.step;//所用步数少的优先 
} 
};


int map[105][105];
int flag[105][105];//记录步骤 
int cnt[105][105];//记录有无怪物及其血量 
int to[4][2]={1,0,-1,0,0,1,0,-1};//代表4个方向 
int n,m,tim;


int check(int x,int y)
{
if(x<0||y<0||x>=n||y>=m)//排除不可能的情况，即出界 
return 1;
if(map[x][y]==-1)//说明是墙，不能走 
return 1;
return 0;
}


int bfs()
{
int i;
priority_queue<node> Q;//Q为优先队列 
node a,next;
a.x=0;
a.y=0;
a.step=0;
map[0][0]=-1;//设起点为墙 
Q.push(a);
while(!Q.empty())
{
a=Q.top();
Q.pop();
if(a.x==n-1&&a.y==m-1)
return a.step;//成功到达 返回步数  结束广度搜索 
for(i=0;i<4;i++)//检查4个方向的可行性 
{ 
next=a;
next.x+=to[i][0];
next.y+=to[i][1];
if(check(next.x,next.y))//剪枝 
         continue;//检查当前点，如不符合条件，结束本次循环，进入下一循环 
        next.step=a.step+map[next.x][next.y]+1;//记录时间 
map[next.x][next.y]=-1;//标记走向，-1代表已经走过 
flag[next.x][next.y]=i+1;//记录朝向 
Q.push(next);
}
} 
return 0;
}


void print(int x,int y)
{
int n_x,n_y;
if(!flag[x][y])//直到x,y没有被访问过 
return;
n_x=x-to[flag[x][y]-1][0];
n_y=y-to[flag[x][y]-1][1];
print(n_x,n_y);//返回前一步，像是倒叙手法 
printf("%ds:(%d,%d)->(%d,%d)\n",tim++,n_x,n_y,x,y);
while(cnt[x][y]--)
{
printf("%ds:FIGHT AT (%d,%d)\n",tim++,x,y);
}
}


int main()
{
int i,j;
while(scanf("%d%d",&n,&m))
{
memset(map,0,sizeof(map));
memset(flag,0,sizeof(flag));
memset(cnt,0,sizeof(cnt));
char s[105];
for(i=0;i<n;i++)
{
scanf("%s",s);
for(j=0;s[j];j++)
{
if(s[j]=='.')
map[i][j]=0;
else if(s[j]=='X')
map[i][j]=-1;
else 
map[i][j]=cnt[i][j]=s[j]-'0'; 
//初始化迷宫结构 
} 
}
int ans=0;
ans=bfs();
if(ans)
{
printf("It takes %d seconds to reach the target position, let me show you the way.\n",ans);
tim=1;
print(n-1,m-1);//调用输出函数 
}
else 
printf("God please help our poor hero.\n");
printf("FINISH\n"); 
}
return 0;
}