南阳OJ——58（最小步数，迷宫问题）

最少步数

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

难度：4

输入

第一行输入一个整数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

描述

这有一个迷宫，有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）。）

#include<stdio.h>
#include<malloc.h>
#define max 1000
int mg[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},
};
typedef struct
{
	int i;
	int j;
	int pre;
}box;

typedef struct
{
	box data[max];
	int front,rear;
}qu;


bool mgpath(int a,int b,int c,int d);

bool en(qu *&s,box e)
{
	if(s->rear==max-1)
	return false;
	s->rear++;
	s->data[s->rear]=e;
	return true;
}
bool de(qu *&s,box &e)
{
	if(s->front==s->rear)
	return false;
	s->front++;
	e=s->data[s->front];
	return true;
}
int length=0;
int main()
{
	int n,a,b,c,d;
	scanf("%d",&n);
	while(n--)
	{
		length=0;
		scanf("%d%d%d%d",&a,&b,&c,&d);
		mgpath(a,b,c,d);
		printf("%d\n",length);
		
	}
	return 0;
}

bool mgpath(int a,int b,int c,int d)
{
	int i,j,di,i1,j1,p,q;
	qu *s;
	box path[max],e;
	s=(qu*)malloc(sizeof(qu));
	s->front=s->rear=-1;
	int mg[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},
};
	
	e.i=a; e.j=b; e.pre=-1;
	en(s,e);
	mg[a][b]=-1;
	
	while(s->front!=s->rear)
	{
		de(s,e);
		i=e.i; j=e.j;
		if(i==c&&j==d)
    	{
    		q=s->front;
    		while(q!=0)// 算出 迷宫步数 
    		{
    			//p=q;
    			q=s->data[q].pre;
    			length++;
			}
		    //printf("%d\n",length);
	    	return true;
    	}
    	else
    	{
    		for(di=0;di<4;di++)//将所有能走的 迷宫入队； 
    		{
    			switch(di)
    			{
    				case 0: i1=i-1; j1=j;   break;
    				case 1:	i1=i;   j1=j+1; break;
    				case 2: i1=i+1; j1=j;   break;
    				case 3: i1=i;   j1=j-1; break;
				}
				if(mg[i1][j1]==0)
				{
					e.i=i1; e.j=j1; e.pre=s->front;
					en(s,e);
					mg[i1][j1]=-1;
				}
			}
		}
 	  
	}
    return false;
}