走迷宫【Ybtoj】

$Description$

现在有一个$N\ast N$的地图，问从起点$(sx,sy)$到(tx, ty)最少要走几步。

$Input$

第一行一个正整数$N$
接下来$N$行，每行$N$个字符，表示$N\ast N$的$0/1$矩阵，$1$表示不能通过，$0$表示可以通过。
最后一行四个整数$sx,sy,tx,ty$。

$Output$

仅有一个数，表示答案。

$Sample$ $Input$

5
01111
00111
10001
11101
11100
1 1 5 5

$Sample$ $Output$

8

$Hint$

对于$100\%$的数据，有$1\le N\le 1000$。

$Train$ $of$ $Thought$

数据不是非常大
就直接用广搜喽

#include<algorithm>
#include<iostream>
#include<cstring>
#include<cstdio>
#include<queue>
using namespace std;

const int dx[5] = {
    
    0, 0, 0, 1, -1};
const int dy[5] = {
    
    0, 1, -1, 0, 0};

int A[1005][1005], Bol[1005][1005];
int dis[1005][1005];
int n, l, r;

bool Check(int x, int y)
{
    
    
	if(x > n || y > n || x < 1 || y < 1)return 0;
	if(A[x][y] || Bol[x][y])return 0;
	return 1;
}

void BFS(int a, int b)
{
    
    
	memset(Bol, 0, sizeof(Bol));
	memset(dis, 0, sizeof(dis));
	queue<int>hx, hy;
	hx.push(a), hy.push(b);
	Bol[a][b] = 1, dis[a][b] = 0;
	while(hx.size())
	{
    
    
		int xx = hx.front(); hx.pop();
		int yy = hy.front(); hy.pop();
		int x = xx + dx[1], y = yy + dy[1];
		for(int i = 1; i <= 4; i++)
			if(Check(xx + dx[i], yy + dy[i]))
			{
    
    
				x = xx + dx[i], y = yy + dy[i];
				dis[x][y] = dis[xx][yy] + 1;
				Bol[x][y] = 1;
				hx.push(x), hy.push(y);
				if(x == l && y == r)
				{
    
    
					printf("%d", dis[x][y]);
					exit(0);
				}
			}
	}
	return;
}

int main()
{
    
    
	scanf("%d", &n);
	for(int i = 1; i <= n; ++i)
		for(int j = 1; j <= n; ++j)
		{
    
    
			char c;
			cin >> c;
			A[i][j] = c - '0';
		}	
	int x, y;
	scanf("%d%d%d%d", &x, &y, &l, &r);
	BFS(x, y);
	return 0;
}