K - 迷宫问题

本题是广搜加深搜的题,注意要从0，0开始

#include<cstdio>
#include<queue>
using namespace std;
const int N=5;
const int maxn=10;
int d[4][2]={{0,1},{0,-1},{1,0},{-1,0}}; 
int g[N][N];
struct node{
	int x,y;
}from[maxn][maxn];
node s={0,0},e={4,4};
void dfs(int x,int y)
{
	if(x==0&&y==0)
	{
		printf("(0, 0)\n");
		return;
	}
	dfs(from[x][y].x,from[x][y].y);
	printf("(%d, %d)\n",x,y);
}
void bfs()
{
	queue<node> q;
	g[0][0]=1;
	q.push(s);
	while(!q.empty())
	{
		s=q.front();q.pop();
		if(s.x==e.x&&s.y==e.y)	return;
		for(int i=0;i<4;i++)
		{
			node th=s;
			th.x+=d[i][0];th.y+=d[i][1];
			int x=th.x,y=th.y;
			//printf("%d %d\n",x,y);
			if(x<0||x>N-1||y<0||y>N-1||g[x][y])	continue;
			q.push(th);
			g[x][y]=1;
			from[x][y]=s;
		}
	}
}
int main()
{
	//freopen("K.txt","r",stdin);
	for(int i=0;i<N;i++)
		for(int j=0;j<N;j++)
			scanf("%d",&g[i][j]);
	bfs();
	dfs(N-1,N-1);
	return 0;
}