广搜_优先队列和记录搜索路径(HDU_1026)

#include <stdio.h>
#include <string.h>
#include <queue>
#include <stack>

using namespace std;

#define M    105

typedef struct Node{
    int row,col,step,f_row,f_col,count;

    friend bool operator < (const Node a,const Node b)
    {
        return a.step>b.step;
    }
} Node;

const int move[4][2]={{-1,0},{1,0},{0,-1},{0,1}};
char map[M][M];
int n,m,sum;

priority_queue<Node> Q;
queue<Node> __Q;
stack<Node> S,__S;

void __clear()
{
    while(!Q.empty())    Q.pop();
    while(!S.empty())    S.pop();
    while(!__Q.empty())    __Q.pop();
    while(!__S.empty())    __S.pop();
}

int jud(Node temp)
{
    if(temp.row>=0 && temp.row<n && temp.col>=0 && temp.col<m && map[temp.row][temp.col]!='X')    return 1;
    return 0;
}

void bfs()
{
    __clear();
    Node temp,add;
    temp.row=temp.col=temp.step=0;
    temp.f_row=temp.f_col=-1;
    temp.count=0;
    map[temp.row][temp.col]='X';
    Q.push(temp);
    while(!Q.empty())
    {
        temp=Q.top();
        Q.pop();
        __Q.push(temp);
        if(temp.row==n-1 && temp.col==m-1)
        {
            sum=temp.step;
            return ;
        }
        for(int i=0;i<4;i++)
        {
            add.row=temp.row+move[i][0];
            add.col=temp.col+move[i][1];
            add.f_row=temp.row;
            add.f_col=temp.col;
            if(!jud(add))    continue;
            add.step=temp.step+1;
            add.count=0;
            if(map[add.row][add.col]!='.')
            {
                add.step=add.step+map[add.row][add.col]-'0';
                add.count=map[add.row][add.col]-'0';
            }
            map[add.row][add.col]='X';
            Q.push(add);
        }
    }
}

void show_path()
{
    while(!__Q.empty())
    {
        S.push(__Q.front());
        __Q.pop();
    }

    int __f_row=S.top().row;
    int __f_col=S.top().col;
    while(!S.empty())
    {
        Node temp=S.top();
        S.pop();
        if(!(__f_row ==temp.row && __f_col ==temp.col))    continue;
        __f_row=temp.f_row;
        __f_col=temp.f_col;
        __S.push(temp);
    }

    int i=1;
    if(sum)    printf("It takes %d seconds to reach the target position, let me show you the way.\n",sum);
    else
    {
        printf("God please help our poor hero.\nFINISH\n");
        return ;
    }
    while(!__S.empty())
    {
        Node temp=__S.top();
        __S.pop();
        if(temp.f_row==-1 && temp.f_col==-1)    continue;
        printf("%ds:(%d,%d)->(%d,%d)\n",i++,temp.f_row,temp.f_col,temp.row,temp.col);
        if(temp.count)    while(temp.count--)    printf("%ds:FIGHT AT (%d,%d)\n",i++,temp.row,temp.col);
//        printf("row=%d,col=%d,step=%d,f_row=%d,f_col=%d\n",temp.row,temp.col,temp.step,temp.f_row,temp.f_col);
    }    
    printf("FINISH\n");
}

int main(int argc, char *argv[])
{
    #ifdef __LOCAL
    freopen("in.txt","r",stdin);
    #endif

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