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）分别表示起点的行、列，终点的行、列。输出输出最少走几步。样例输入

2
3 1  5 7
3 1  6 7

样例输出

12
11

#include<cstdio>
#include<queue>
#include<cstring>
using namespace std;
int sx,sy,ex,ey;
int d[4][2]={1,0,0,1,-1,0,0,-1};
bool visit[9][9];

int G[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 point
{
int x;
int y;
int step;
};

int bfs()
{
point init;
init.x=sx;
init.y=sy;
init.step=0;
queue<point>q;
q.push(init);
while(!q.empty())
{
point node=q.front();
q.pop();
if(node.x==ex&&node.y==ey)
return node.step;
for(int i=0;i<4;i++)
{
point newnode;
newnode.x=node.x+d[i][0];
newnode.y=node.y+d[i][1];
newnode.step=node.step+1;
if(!G[newnode.x][newnode.y]&&visit[newnode.x][newnode.y])
q.push(newnode);
visit[node.x][node.y]=false;
}
}
}

int main()
{
//freopen("in.txt","r",stdin);
int t;
scanf("%d",&t);
while(t--)
{
memset(visit,true,sizeof(visit));
scanf("%d%d%d%d",&sx,&sy,&ex,&ey);
int ans=bfs();
printf("%d\n",ans);
}
return 0;
}