二维的BFS 注意平行于坐标轴走就是 X,Y减一活减0 并且把原点移到(500,500),所以每个点的坐标都要加上500后就可用BFS求解了。
参考代码如下:
#include<iostream>
using namespace std;
#define N 1100
int turn[4][2]={{1,0},{-1,0},{0,1},{0,-1}};
bool map[N][N];
int count[N][N];
bool visit[N][N];
struct Queue
{
int x,y;
}q[500000];
int x,y;
bool bfs()
{
int i,f=0,r=0;
int a,b,c=500,d=500;
memset(visit,false,sizeof(visit));
memset(count,0,sizeof(count));
visit[c][d]=true;
q[r].x=c;
q[r].y=d;
r++;
while(f<r)
{
c=q[f].x;
d=q[f].y;
f++;
for(i=0;i<4;i++)
{
a=turn[i][0]+c;
b=turn[i][1]+d;
if(!visit[a][b] && map[a][b] && a>=0 && a<=1001 && b>=0 && b<=1001)
{
visit[a][b]=true;
count[a][b]=count[c][d]+1;
if(a==x+500 && b==y+500)
return true;
q[r].x=a;
q[r].y=b;
r++;
}
}
}
return false;
}
int main()
{
int n,i;
int a,b;
bool flag;
scanf("%d%d%d",&x,&y,&n);
memset(map,true,sizeof(map));
for(i=0;i<n;i++)
{
scanf("%d%d",&a,&b);
map[a+500][b+500]=false;
}
flag=bfs();
if(flag)
printf("%d/n",count[x+500][y+500]);
return 0;
}