P1907 设计道路

这是一道典型的最短路径题，用Dijkstra算法算法解决。算法复杂度为O（n^2）。

朴素的Dijkstra算法使用与稠密图单源最短路径，即边数远远大于顶点数的图，如果使用优先队列实现的Dijkstra算法称为堆优化的Dijkstra算法，算法复杂度可以达到O（m*log n）。（m为边的条数，n为顶点数）

#include<iostream>
#include<string.h>
#include<stdlib.h>
#include<algorithm>
#include<math.h>
#include<vector>
using namespace std;
const double INF=0x3f3f3f3f;

double rl,dl;
int n;
double a[1010][1010];
double edge[1010][2];
double x_1,y_1,x_2,y_2;
double dist(double x1,double y1,double x2,double y2)
{
	return sqrt((x1-x2)*(x1-x2)+(y1-y2)*(y1-y2));
}

double d[1010];
bool val[1010]={false};

void dijkstra(int s)
{
	memset(d,127,sizeof(d));
	d[s]=0;
	for(int i=0;i<=n+1;i++)//遍历n+2个点 （n个点加上起点与终点=n+2） 
	{
		int u=-1;
		double Min=INF;
		for(int j=0;j<=n+1;j++) //寻找 n+2个点中离源点最小的点 
		{
			if(val[j]==false&&d[j]<Min)
			{
				u=j;
				Min=d[j];
			}
		}
		if(u==-1) return; 
		val[u]=true;//标记新找到的点 
		for(int v=0;v<=n+1;v++)//判断新找到的点能否作为中转点使其他点到源点的距离变小 
		{
			if(val[v]==false&&a[u][v]!=INF&&d[u]+a[u][v]<d[v])
			{
				d[v]=d[u]+a[u][v];
			}
		}
		
	}
	
}

int main()
{
	cin>>dl>>rl;
	cin>>n;
	fill(a[0],a[0]+1010*1010,100000);
	for(int i=1;i<=n;i++)
	{
		cin>>edge[i][0]>>edge[i][1];
	}
	
	int c,e;
	cin>>c>>e;
	while(c!=0&&e!=0) //初始化 
	{
		a[c][e]=dist(edge[c][0],edge[c][1],edge[e][0],edge[e][1])*rl;
		a[e][c]=a[c][e];
		cin>>c>>e;
	}
	cin>>x_1>>y_1;
	cin>>x_2>>y_2;
	edge[0][0]=x_1;edge[0][1]=y_1;
	edge[n+1][0]=x_2;edge[n+1][1]=y_2;

	for(int i=0;i<=n+1;i++)
	{
		for(int j=0;j<=i;j++)
		{
			if(a[i][j]==100000)
			{
				a[i][j]=dist(edge[i][0],edge[i][1],edge[j][0],edge[j][1])*dl;
				a[j][i]=a[i][j];
			}
		}
	}

	dijkstra(0);
    printf("%.4lf",d[n+1]);

	return 0;
}