离开中山路

题目描述

爱与愁大神买完东西后，打算坐车离开中山路。现在爱与愁大神在 x1,y1 处，车站在 x2,y2 处。

现在给出一个 n×n（n<=1000）的地图，0 表示马路，1 表示店铺（不能从店铺穿过），爱与愁大神只能垂直或水平着在马路上行进。

爱与愁大神为了节省时间，他要求最短到达目的地距离（a[i][j] 距离为 1）。

你能帮他解决吗？

（测试数据保证可以走到车站）

输入格式

第 1 行：一个数 n

第 2 行~第 n+1 行：整个地图描述（0 表示马路，1 表示店铺，注意两个数之间没有空格）

第 n+2 行：四个数 x1, y1, x2, y2

输出格式

只有 1 行：最短到达目的地距离

样例输入

3
001
101
100
1 1 3 3

样例输出

4

问题提示

20% 数据：n<=100

100% 数据：n<=1000

代码如下：

#include<iostream>
using namespace std;
int n,x1,y1,x2,y2,h,t,a[1005][1005],st[1000005][3];
int dx[9]={0,1,-1,0,0};
int dy[9]={0,0,0,1,-1};
char ch;
void bfs()
{
	while(h<t)
	{
		h++;
		for(int i=1;i<=4;i++)
		 {
		 	int x=st[h][0]+dx[i],y=st[h][1]+dy[i];
		 	if(x>=1&&x<=n&&y>=1&&y<=n)
		 	 if(a[x][y]==0)
		 	  {
		 	  	t++;
		 	  	a[x][y]=1;
		 	  	st[t][2]=st[h][2]+1;
			    st[t][0]=x;st[t][1]=y;
			    if(x==x2&&y==y2)return;
			  }
		 }
	}
}
int main()
{
	cin>>n;
	for(int i=1;i<=n;i++)
	 for(int j=1;j<=n;j++)
	  {cin>>ch;a[i][j]=ch-48;}
	cin>>x1>>y1>>x2>>y2;
	st[1][0]=x1;st[1][1]=y1;
	a[x1][y1]=1;
	t=1;
	bfs();
	cout<<st[t][2];
	return 0;
}