nyoj 58 最少步数 【BFS】

这有一个迷宫，有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）分别表示起点的行、列，终点的行、列。

输出

输出最少走几步。

样例输入

23 1 5 73 1 6 7

样例输出

1211

分析：

这道题基本上算是一个果的广搜。

代码：

#include<cstdio>
#include<cstring>
#include<cstdlib>
#include<queue>
#include<iostream>
#include<algorithm>
#define N 9
using namespace std;
int map[N][N] =   
{  
    {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}  
};  

int dis[4][2]={1,0,-1,0,0,1,0,-1};
int vis[110][110];
struct node{
	int x;
	int y;
	int step;
	friend bool operator<(node a,node b)
	{
		return a.step<b.step;
	}
};
int sx,sy,ex,ey;
node a,b;
int bfs()
{
  priority_queue<node>q;
  a.x=ex;
  a.y=ey;
  a.step=0;
  memset(vis,0,sizeof(vis));
  vis[a.x][a.y]=1;
  q.push(a);
  while(!q.empty())
  {
  	a=q.top();
  	q.pop();
  	if(a.x==sx&&a.y==sy)
  	return a.step;
  	//vis[a.x][a.y]=1;
  	for(int i=0;i<4;i++)
  	{
  		b.x=a.x+dis[i][0];
  		b.y=a.y+dis[i][1];
  		b.step=a.step+1;
  		if(b.x>=0&&b.x<=8&&b.y>=0&&b.y<=8&&!vis[b.x][b.y]&&!map[b.x][b.y])
  		{
  			vis[b.x][b.y]=1;
  			//map[b.x][b.y]=1;
  			q.push(b);
  		}
  	}
  }
	return -1;
}

int main()
{
	int t;
	cin>>t;
	while(t--)
	{
		cin>>ex>>ey>>sx>>sy;

                //map[ex][ey]=1;  千万要记住这个地方不能改变图的数据，不然再接下来的测试数据中将会出错。我就在这个地方出现了错误 找了好久才找到。修炼不够啊。
		printf("%d\n",bfs());
	}
	return 0;
}