最少步数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<iostream>
#include<cstring>
#include<queue>
using namespace std;

typedef pair<int,int> P;

int a[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
};
int b[9][9],T,x1,y1,x2,y2;
int c1[] = {-1,1,0,0};
int c2[] = {0,0,-1,1};
queue<P> que;
int main(){

cin>>T;
while(T--){
for(int i = 0;i < 9;i++) for(int j = 0;j < 9;j++) b[i][j] = 65535;
cin>>x1>>y1>>x2>>y2;
b[x1][y1] = 0;
que.push(P(x1,y1));
while(!que.empty()){
P temp = que.front();que.pop();
//判断是否到达终点
if(temp.first == x2 && temp.second == y2) break;

for(int i = 0;i < 4;i++){
int x = temp.first + c1[i],y = temp.second + c2[i];
if(x >= 0 && x < 9 && y >= 0 && y < 9 && a[x][y] == 0 && b[x][y] == 65535){
que.push(P(x,y));
b[x][y] = b[temp.first][temp.second] + 1;
}
}
}
while(!que.empty()) que.pop();
cout<<b[x2][y2]<<endl;
}
return 0;
}