HDU1026 （BFS）

题意：从起点到终点，输出路径长度，时间。

bfs+记录路径

#include<stdio.h>
#include<string.h>
#include<stdlib.h>
#include<queue>
const int N = 105;
const int inf = 9999999;
using namespace std;

struct node{
    int x,y;
};
node p,pp,path[N][N];
struct node2{
    int x1,y1,x2,y2;
}out[1000005];

char map[N][N];
int time[N][N];
int n,m,endflag,ans;
queue<node>q;

const int dx[]={1,-1,0,0};
const int dy[]={0,0,1,-1};

void init(){
    for(int i=0;i<N;i++)
        for(int j=0;j<N;j++){
            path[i][j].x=-1;
            path[i][j].y=-1;
            time[i][j]=inf;
        }
}

bool judge(int x,int y){
    if(map[x][y]>='1'&&map[x][y]<='9')
        return true;
    return false;
}

void output(){
    int nowx,nowy,tpx,tpy,cnt=1;
    nowx=n-1;
    nowy=m-1;
    while(nowx!=0||nowy!=0){
        out[cnt].x1=path[nowx][nowy].x;
        out[cnt].y1=path[nowx][nowy].y;
        out[cnt].x2=nowx;
        out[cnt++].y2=nowy;
        tpx=nowx;
        tpy=nowy;
        nowx=path[tpx][tpy].x;
        nowy=path[tpx][tpy].y;
    }

    int cnt2=1;
    for(int i=cnt-1;i>=1;i--)
    {
        if(judge(out[i].x1,out[i].y1)==false)
            printf("%ds:(%d,%d)->(%d,%d)\n",cnt2++,out[i].x1,out[i].y1,out[i].x2,out[i].y2);
        else
        {
            int pp;
            pp=map[out[i].x1][out[i].y1]-'0';
            for(int j=1;j<=pp;j++)
                printf("%ds:FIGHT AT (%d,%d)\n",cnt2++,out[i].x1,out[i].y1);
            printf("%ds:(%d,%d)->(%d,%d)\n",cnt2++,out[i].x1,out[i].y1,out[i].x2,out[i].y2);
        }
    }
    if(endflag!=-1){
    int pp;
    pp=endflag;
        for(int j=1;j<=pp;j++)
            printf("%ds:FIGHT AT (%d,%d)\n",cnt2++,n-1,m-1);
    }
    printf("FINISH\n");
}

void bfs(){
    int i,j,k;
    ans=inf;
    endflag=-1;
    while(!q.empty())q.pop();
    p.x=0;
    p.y=0;
    time[p.x][p.y]=0;
    if(judge(0,0)==true)
        time[0][0]=map[0][0]-'0';
    q.push(p);
    while(!q.empty()){
        p=q.front();
        q.pop();
        
        if(p.x==n-1&&p.y==m-1)
            if(time[n-1][m-1]<ans)
                ans=time[n-1][m-1];
                
        for(i=0;i<4;i++){
            pp.x=p.x+dx[i];
            pp.y=p.y+dy[i];
            if(pp.x<0||pp.x>=n||pp.y<0||pp.y>=m)
                continue;
            if(map[pp.x][pp.y]=='X')
                continue;
            if(map[pp.x][pp.y]=='.'&&time[pp.x][pp.y]>(time[p.x][p.y]+1)){
                time[pp.x][pp.y]=time[p.x][p.y]+1;
                path[pp.x][pp.y].x=p.x;
                path[pp.x][pp.y].y=p.y;
                q.push(pp);
            }
            if(map[pp.x][pp.y]>='1'&&map[pp.x][pp.y]<='9'){
                if(time[pp.x][pp.y]>(time[p.x][p.y]+map[pp.x][pp.y]-'0'+1)){
                    time[pp.x][pp.y]=time[p.x][p.y]+map[pp.x][pp.y]-'0'+1;
                    path[pp.x][pp.y].x=p.x;
                    path[pp.x][pp.y].y=p.y;
                    if(pp.x==n-1&&pp.y==m-1){
                        endflag=map[pp.x][pp.y]-'0';
                    }
                    q.push(pp);
                }
            }
        }
    }
    
    if(ans!=inf){
        printf("It takes %d seconds to reach the target position, let me show you the way.\n",ans);
        output();
    }
    else
        printf("God please help our poor hero.\nFINISH\n");
    return ;
}

int main(){
    int i;
    while( scanf("%d%d",&n,&m)!=EOF ){
        memset(map,0,sizeof(map));
        for(i=0;i<n;i++)
            scanf("%s",map[i]);
        init();
        bfs();
    }
    return 0;
}