nyoj 58 最少步数 【BFS+优先队列】

最少步数

时间限制： 3000 ms  |           内存限制： 65535 KB

难度： 4

描述

这有一个迷宫，有0~8行和0~8列：

1,1,1,1,1,1,1,1,1
1,0,0,1,0,0,1,0,1
1,0,0,1,1,0,0,0,1
1,0,1,0,1,1,0,1,1
1,0,0,0,0,1,0,0,1
1,1,0,1,0,1,0,0,1
1,1,0,1,0,1,0,0,1
1,1,0,1,0,0,0,0,1
1,1,1,1,1,1,1,1,1

0表示道路，1表示墙。

现在输入一个道路的坐标作为起点，再如输入一个道路的坐标作为终点，问最少走几步才能从起点到达终点？

（注：一步是指从一坐标点走到其上下左右相邻坐标点，如：从（3，1）到（4,1）。）

输入

第一行输入一个整数n（0<n<=100），表示有n组测试数据;
随后n行,每行有四个整数a,b,c,d（0<=a,b,c,d<=8）分别表示起点的行、列，终点的行、列。

输出

输出最少走几步。

样例输入

2
3 1  5 7
3 1  6 7

样例输出

12
11

广搜+优先队列：

#include<stdio.h>
#include<queue>
#include<string.h>
using namespace std;
int visit[9][9];
int map[9][9]=
    {
        1,1,1,1,1,1,1,1,1,
        1,0,0,1,0,0,1,0,1,
        1,0,0,1,1,0,0,0,1,
        1,0,1,0,1,1,0,1,1,
        1,0,0,0,0,1,0,0,1,
        1,1,0,1,0,1,0,0,1,
        1,1,0,1,0,1,0,0,1,
        1,1,0,1,0,0,0,0,1,
        1,1,1,1,1,1,1,1,1,
    };
struct node
{
    int x;
    int y;
    int step;
    friend bool operator <(node a,node b)
    {
        return a.step>b.step;//步数最少优先 
    }
};
void bfs(int startx,int starty,int endx,int endy)
{
    int k,exist=0;
    int move[4][2]={0,1,0,-1,1,0,-1,0};
    node now,next;
    priority_queue<node>q;
    now.x=startx;
    now.y=starty;
    now.step=0;
    q.push(now);
    while(!q.empty())
    {
        next=q.top();
        q.pop();
        if(next.x==endx&&next.y==endy)
        {
            exist=1;
            break;
        }
        for(k=0;k<4;k++)
        {
            now.x=next.x+move[k][0];
            now.y=next.y+move[k][1];
            if(!visit[now.x][now.y]&&now.x>=0&&now.x<9&&now.y>=0&&now.y<9&&map[now.x][now.y]!=1)
            {
                visit[now.x][now.y]=1;
                now.step=next.step+1;
                q.push(now);
            }
        }
    }
    if(exist)
    printf("%d\n",next.step);
    else
    printf("-1\n");
} 
int main()
{
    int t,startx,starty,endx,endy;
    scanf("%d",&t);
    while(t--)
    {
        scanf("%d%d%d%d",&startx,&starty,&endx,&endy);
        memset(visit,0,sizeof(visit));
        bfs(startx,starty,endx,endy);
    }
    return 0;
}