最少步數

描述

這有一個迷宮，有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>
#include<limits.h>
using std::queue;
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 vis[9][9]; 
 struct Node
 {
    int x,y;
    int step;
 }end,cur,next;
 int x_move[]={0,0,1,-1};
 int y_move[]={1,-1,0,0};
 bool judge()
 {
 if(next.x>=0&&next.x<9&&next.y>=0&&next.y<9&&!map[next.x][next.y]) return 1;
 return 0;
 }
 void BFS()
 {
 	queue<Node>q;
 	for(int i=0;i<9;i++)
 	  for(int j=0;j<9;j++)
 	    vis[i][j]=INT_MAX;
 	while(!q.empty())q.pop();
    //printf("%d\n",q.front().step);
      cur.step=0;//當前步數要初始化，否則會在上一次的基礎上相加 
	  next=cur;
	  vis[cur.x][cur.y]=0;//記得將第一步初始化 
    for(int i=0;i<4;i++)
      {
      	next=cur;
	    next.x+=x_move[i];
	    next.y+=y_move[i];
	     if(vis[next.x][next.y]==INT_MAX&&!map[next.x][next.y])
	       {
		      next.step++;
		     vis[next.x][next.y]=next.step;
		     q.push(next);
		   }
	  }
	  while(!q.empty())//q.size();也可以 
	  {
	     cur=q.front();
	    // printf("%d ",cur.step);
	       q.pop();
		 for(int i=0;i<4;i++)
		  {
		      next=cur;
		     next.x+=x_move[i];
		     next.y+=y_move[i];
		     if(vis[next.x][next.y]==INT_MAX&&judge())
	       { 
		         next.step++;
	       	// if(vis[next.x][next.y]>next.step);
		         vis[next.x][next.y]=next.step;
		         //printf("%d ",vis[next.x][next.y]);
		     q.push(next);
		   }
		   
		  } 
	  }
	  printf("%d\n",vis[end.x][end.y]);
	   
 };
int main()
{
  int N;
  scanf("%d",&N);
  while(N--)
  {
  	scanf("%d%d%d%d",&cur.x,&cur.y,&end.x,&end.y);
  	BFS();
  	/*
    for(int i=0;i<9;i++)
    {
      for(int j=0;j<9;j++)
      {
	     printf("%d ",a[i][j]);
	  }
      printf("\n");
    }
   */
  }	
return 0;
}