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

思路：bfs模板题，搜索树的同一层找到最优解；

now表示即将压入队顶元素的结构体变量，next表示目前的队顶元素，也即是即将移除的队顶元素；

#include<cstdio>
#include<cstring>
#include<algorithm>
#include<queue>
using namespace std;
int visit[110][110];//记录是否访问；
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;
	bool friend operator<(node a,node b)
	{
		return a.step>b.step;
	}
};
void bfs(int startx,int starty,int endx,int endy)
{
	bool flag=false;
	priority_queue<node> q;
	int move[4][2]={0,1,0,-1,1,0,-1,0};
	node now,next;
	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)
		{
			flag=true;
			break;
		}
		for(int i=0;i<4;i++)
		{
			now.x=next.x+move[i][0];
			now.y=next.y+move[i][1];
			if(!visit[now.x][now.y] && map[now.x][now.y]==0 && now.x>=0 && now.x<9 && now.y>=0 && now.y<9)
			{
				visit[now.x][now.y]=1;
				now.step=next.step+1;
				q.push(now);
			}
		}
	}
	if(flag) printf("%d\n",next.step);
	else printf("-1\n");
}
int main()
{
	int x1,x2,y1,y2,t;
	scanf("%d",&t);
	while(t--)
	{
		memset(visit,0,sizeof(visit));
		scanf("%d %d %d %d",&x1,&y1,&x2,&y2);
		bfs(x1,y1,x2,y2);
	}
	return 0;
}