矿工冒险记

现在你控制的人物在一个N×M的场地中，左上角的方格为 (0, 0)，右下角为 (N – 1, M – 1)，你一开始的位置在 (SX, SY)，你家的位置则在 (EX, EY)。身为一个矿工，你身上早就有了好几组铁和钻石，所以你正匆忙地赶回家里。但是有某些格子被设下了陷阱，如果走到上面就会粉身碎骨，立刻 Game Over。你当然不想 Game Over，所以你要避开这些格子。

假设每单位时间能向上、下、左、右移动一个格子，请你计算一下最短回家的时间。

输入格式

一个整数 T，表示有多少组测试数据。

接下来的 T 组测试数据，每组测试数据第一行是两个正整数 N, M (1 <= N, M <= 10)，表示场地大小。

第二行有一个正整数 P (0 <= P <= N × M)，表示有多少个方格被设下了陷阱。

接下来的 P 行，每行是两个整数 X, Y，表示陷阱坐标。

最后一行是四个整数 SX, SY, EX, EY，表示起始位置和家的位置。

注意，行走不能超出地图边界。

输出格式

对于每组输入数据，输出一行一个数字，表示最少需要的回家时间。假如有不可能完成任务的情况，输出 -1。

样例输入

1
3 3
2
1 1
1 2
0 0 2 2

样例输出

4

本题使用广度优先搜索算法，因为相邻两点的长度都一样，所以先到终点的就是最短路径。

下面是本人的代码：

#include<stdio.h>
#include<queue>
#include<string.h>
using namespace std;

struct Point
{
	int x;
	int y;
	Point(int a,int b){x=a;y=b;}
};

int a[10][10];
int N, M, P;
int SX, SY, EX, EY;
int xi[4]={-1,  1,  0, 0}; //搜索方向：上，下，左，右
int yi[4]={  0,  0, -1, 1};
void print()
{
	int i,j;
	for(i=0;i<M;i++)
	{
		for(j=0;j<N;j++)
			printf("%d ",a[i][j]);
		printf("\n");
	}
}

int BFS()
{
	queue<Point> q;
	q.push(Point(SX, SY));
	while(!q.empty())
	{
		Point p=q.front();
		if(p.x==EX && p.y==EY)
			return a[EX][EY];
		q.pop();
		int tempX, tempY, i,  j;
		for(i=0;i<4;i++)
		{
			tempX=p.x;
			tempY=p.y;
			tempX=tempX+xi[i];
			tempY=tempY+yi[i];
			if(tempX>=0 && tempY>=0 && tempX<M && tempY<N && a[tempX][tempY]==0) //没有越界、不是陷阱、未被访问过
			{
				q.push(Point(tempX, tempY));
				a[tempX][tempY]=a[p.x][p.y]+1; //更新位置(tempX, tempY)到(SX,SY)的距离
				if(tempX==EX && tempY==EY)
					return a[tempX][tempY];
				//a[tempX][tempY]=1;
			}	
		}
	}
	return -1;
}
int main()
{
	int T;
	scanf("%d",&T);
	while(T--)
	{
		int i, j;
		memset(a,0,sizeof(a)); //初始化值为0
		int x,y;
		scanf("%d%d%d",&M,&N,&P);
		for(i=0;i<P;i++)
		{
			scanf("%d%d",&x,&y);
			a[x][y]=-1; //将有陷阱的地方的值，置为-1
		}
		scanf("%d%d%d%d",&SX, &SY, &EX, &EY);
		int dis=BFS();
		printf("%d\n",dis);
		//print();
	}

}