我爱崔老师系列之 BFS+优先队列+路径记录 HDU 1026 Ignatius and the Princess I(BFS）

题目

崔老师推荐，用BFS找路径，然后由于一开始的时候不知道那个打架的时间要费时然后WA了一次，然后当时看见有discuss里说开头可能有怪兽然后又没加优先队列然后又WA了了一次，最后因为优先队列的那个排序错了又WA了一次，一晚上就只做了这一道题。。。悲哀= =。。。

#include<stdio.h>
#include<string.h>
char map[205][205];
struct node
{
    int x,y,step,f;//f存先驱，step是当前的步数。
}q[400005];

int way[400005];//用来最后存路径
int f,r,m,n,fa,leap;
int vis[205][205];
int to[4][2] = {{0,1},{0,-1},{1,0},{-1,0}};//四个方向
void sort()//优先队列排序
{
    int i;
    struct node t;
    for(i = r;i > f;i--)
    {
        if(q[i].step < q[i-1].step)
        {
            t = q[i];
            q[i] =q[i-1];
            q[i-1] = t;
        }
        else
        break;
    }
}
void bfs()
{
    int i,j,nx,ny;
    memset(vis,0,sizeof(vis));
    f = r = 0;
    leap = 0;
    q[r].x = 0;
    q[r].y = 0;
    if(map[0][0] == 'X')//看看开头能不能走
    leap = 0;
    else
    {

    if(map[0][0] != '.'&& map[0][0] != 'X')//如果是数字的话开头是不能直接将STEP = 0 的。
    q[r].step = map[0][0]-'0';
    else
    q[r].step = 0;
    q[r].f = -1;
    vis[0][0] = 1;
    r++;
    while(f < r)
    {
        struct node now;
        fa = f;
        now = q[f++];
        for(i = 0;i < 4;i++)
        {
            nx = now.x+to[i][0];
            ny = now.y+to[i][1];

            if(nx >= 0 && nx < m && ny >= 0 && ny < n && map[nx][ny] != 'X' && !vis[nx][ny])
            {
                q[r].x = nx;
                q[r].y = ny;

                q[r].f = fa;
                if(map[nx][ny] == '.')
                q[r].step = now.step+1;
                else
                q[r].step = map[nx][ny]-'0'+now.step + 1;

                if(nx == m-1 && ny == n-1)
                {
                    leap = 1;
                    break;
                }
                 sort();//优先队列排序。。。这里一定不要加错位置、
                r++;
                vis[nx][ny] = 1;
            }
        }
        if(leap)
        break;
    }
    }
}
int main()
{


     
    int i,count,j,nt;
    while(~scanf("%d %d",&m,&n))
    {
        if(!(m||n))
        break;
        memset(map,0,sizeof(map));
        for(i = 0;i < m;i++)
        scanf("%s",map[i]);
        bfs();
        if(leap)
        {
            printf("It takes %d seconds to reach the target position, let me show you the way.\n",q[r].step);
            count = -1;
            while(1)
            {
                way[++count] = r;
                r = q[r].f;
                if(r == -1)
                break;
            }
            nt = 1;
            for(i = count;i > 0;i--)
            {
                printf("%ds:(%d,%d)->(%d,%d)\n",nt++,q[way[i]].x,q[way[i]].y,q[way[i-1]].x,q[way[i-1]].y);
                if(map[q[way[i-1]].x][q[way[i-1]].y] != '.' )
                {
                    int time;
                    time = map[q[way[i-1]].x][q[way[i-1]].y]-'0';
                    for(j = 0;j < time;j++)
                    {
                        printf("%ds:FIGHT AT (%d,%d)\n",nt++,q[way[i-1]].x,q[way[i-1]].y);
                    }
                }
            }

        }
        else
        puts("God please help our poor hero.");
        puts("FINISH");
    }
    return 0;
}