jzoj3086 [分層圖最短路]

分層圖最短路即可

#include<bits/stdc++.h>
using namespace std;
#define N 1000010
int n,m,v[N*2],nxt[N*2],w[N*2],h[N],ec,d[N],vis[N],s,t,x[N],y[N],sx,sy,tx,ty;
void add(int x,int y,int z){v[++ec]=y;w[ec]=z;nxt[ec]=h[x];h[x]=ec;}
void bfs(){
	queue<int>q;
	q.push(s);
	vis[s]=1;
	memset(d,63,sizeof(d));
	d[s]=0;
	while(!q.empty()){
		int x=q.front();
		q.pop();
		vis[x]=0;
		for(int i=h[x];i;i=nxt[i])
			if(d[v[i]]>d[x]+w[i]){
				d[v[i]]=d[x]+w[i];
				if(!vis[v[i]]){
					vis[v[i]]=1;
					q.push(v[i]);
				}
			}
	}
}
bool c1(int a,int b){return y[a]<y[b];}
bool c2(int a,int b){return x[a]<x[b];}
vector<int>vc[100010];
int main(){
	scanf("%d%d",&n,&m);
	for(int i=1;i<=m;i++)
		scanf("%d%d",&x[i],&y[i]);
	for(int i=1;i<=m;i++)
		vc[x[i]].push_back(i);
	for(int i=1;i<=n;i++)
		sort(vc[i].begin(),vc[i].end(),c1);
	for(int i=1;i<=n;i++)
		for(int j=0;j<vc[i].size();j++)
			if(j!=vc[i].size()-1){
				int a=vc[i][j],b=vc[i][j+1];
				add(a*2-1,b*2-1,abs(y[a]-y[b])*2);
				add(b*2-1,a*2-1,abs(y[a]-y[b])*2);
			}
	for(int i=1;i<=n;i++)
		vc[i].clear();
	for(int i=1;i<=m;i++)
		vc[y[i]].push_back(i);
	for(int i=1;i<=n;i++)
		sort(vc[i].begin(),vc[i].end(),c2);
	for(int i=1;i<=n;i++)
		for(int j=0;j<vc[i].size();j++)
			if(j!=vc[i].size()-1){
				int a=vc[i][j],b=vc[i][j+1];
				add(a*2,b*2,abs(x[a]-x[b])*2);
				add(b*2,a*2,abs(x[a]-x[b])*2);
			}
	for(int i=1;i<=m;i++){
		add(i*2,i*2-1,1);
		add(i*2-1,i*2,1);
	}
	scanf("%d%d%d%d",&sx,&sy,&tx,&ty);
	s=m*2+3;t=m*2+4;
	for(int i=1;i<=m;i++){
		if(sy==y[i])add(s,i*2,abs(sx-x[i])*2);
		if(sx==x[i])add(s,i*2-1,abs(sy-y[i])*2);
	}
	for(int i=1;i<=m;i++){
		if(tx==x[i])add(i*2-1,t,abs(ty-y[i])*2);
		if(ty==y[i])add(i*2,t,abs(tx-x[i])*2);
	}
	bfs();
	printf("%d",d[t]>1000000000?-1:d[t]);
}