布线问题-队列式分支限界

#include<bits/stdc++.h>
using namespace std;
const int N=510;
typedef pair<int,int>PII;
int g[N][N];//表示地图形状
int dist[N][N];//表示到各点的一个最短距离
int n;//表示行数
int dx[]={-1,0,1,0},dy[]={0,1,0,-1};
int a,b,c,d;
void findpath(){
	queue<PII>q;
	q.push({a,b});
	dist[a][b]=0;
	while(q.size()){
		PII t=q.front();
		q.pop();
		for(int i=0;i<4;i++){
			int x1=dx[i]+t.first;
			int y1=dy[i]+t.second;
		if(x1>=1&&x1<=n&&y1>=1&&y1<=n&&dist[x1][y1]==-1&&g[x1][y1]==0){
			dist[x1][y1]=dist[t.first][t.second]+1;
			q.push({x1,y1});
			if(x1==c&&y1==d) return;
		}
	}
	
}
}
int main(){
	cin>>n;
	memset(dist,-1,sizeof dist);
	memset(g,-1,sizeof g);//同时赋予地图边界，在广度优先搜索的时候方便
	for(int i=1;i<=n;i++){
		for(int j=1;j<=n;j++){
			cin>>g[i][j];
		}
	}
	cin>>a>>b;//初始位置
	cin>>c>>d;
	findpath();
	cout<<dist[c][d];
	return 0;	
}