nyoj 58 最少步数

最少步数

时间限制： 3000 ms  |  内存限制： 65535 KB

难度： 4

描述

这有一个迷宫，有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<stdio.h>
#include<string.h>
#include<queue>
using namespace std;
int map[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 m,n,e,q;
 int biaoji[9][9]={0};
 int yidong1[4]={1,0,-1,0};
 int yidong2[4]={0,1,0,-1};
 struct node{
  int a;
  int b;
  int step;
 };
int  BFS(int a,int b)
 {
  memset(biaoji,0,sizeof(biaoji));
  node y,t;
  int i;
    queue<node>Q;
  t.a=a;
  t.b=b;
  t.step=0;
  Q.push(t);biaoji[a][b]=1;
 
  while(!Q.empty())
  {
  y=Q.front();
  Q.pop();
  if(y.a==e && y.b==q)
  return y.step;
  else
  {
       int o1,o2;
  for(i=0;i<4;i++)
  {
  o1=y.a+yidong1[i];
  o2=y.b+yidong2[i];
  if(0<=o1 && o1<=8 && o2<=8 && o2>=0 && map[o1][o2]==0 && biaoji[o1][o2]==0)
  {
  Q.push((node){o1,o2,y.step+1});
  biaoji[o1][o2]=1;
  }
  }
  }
 
  }
  return -1;
 }
 int main()
 {
  int T;
  scanf("%d",&T);
  while(T--)
  {
 
  scanf("%d %d %d %d",&m,&n,&e,&q);
 
  int num=BFS(m,n);
  printf("%d\n",num);
  }
 }