矿工冒险记

现在你控制的人物在一个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。

样例输入

13 321 11 20 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)); //初始化值为0int 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();}}