POJ-2502 Subway

题目链接：https://vjudge.net/problem/POJ-2502

最短路问题，起点终点以及每个地铁站都作为一个点，然后计算出他们之间到达的最短时长

这样就是建图的时候麻烦一些，建完之后直接用一次spfa就得出了答案

要注意地铁站只计算两两相连地，两两每个点之间都要计算步行时间

#include<iostream>
#include<cstdio>
#include<cstring>
#include<algorithm>
#include<cmath>
#include<queue>
using namespace std;
const int N=200+10;
const double inf=999999999.9;
double g[N][N];
double x[N],y[N];
bool vis[N];
double ds[N];
int cnt;
double dis(double a,double b,double c,double d)
{
	return sqrt((a-c)*(a-c)+(b-d)*(b-d));
}
int main()
{
	double p,q,p0,q0;
	for(int i=0;i<N;i++)
	for(int j=0;j<N;j++)
	g[i][j]=inf;
	cnt=2;
	scanf("%lf%lf%lf%lf",&x[0],&y[0],&x[1],&y[1]);
	g[0][1]=dis(x[0],y[0],x[1],y[1])*3/500;
	while(~scanf("%lf%lf",&p,&q))
	{
		bool flag=false;
		while(1)
		{
			if(p==-1.0&&q==-1.0)
			break;
			for(int i=0;i<cnt;i++)
			g[i][cnt]=g[cnt][i]=dis(p,q,x[i],y[i])*3/500;
			if(flag)
			{
				g[cnt-1][cnt]=dis(p,q,p0,q0)*3/2000;
				g[cnt][cnt-1]=dis(p,q,p0,q0)*3/2000;
			}
			x[cnt]=p;y[cnt]=q;
			cnt++;
			flag=true;
			p0=p;q0=q;
			scanf("%lf%lf",&p,&q);
		}
	}
	for(int i=0;i<cnt;i++)
	ds[i]=inf;
	queue<int> qu;
	memset(vis,false,sizeof(vis));
	qu.push(0);
	ds[0]=0.0;vis[0]=true;
	while(!qu.empty())
	{
		int pos=qu.front();qu.pop();
		vis[pos]=false;
		for(int i=0;i<cnt;i++)
		if(ds[i]>ds[pos]+g[pos][i])
		{
			ds[i]=ds[pos]+g[pos][i];
			if(!vis[i])
			qu.push(i);
			vis[i]=true;
		}	
	}
	printf("%d\n",(int)(ds[1]+0.5));
	return 0;
}