POJ 1556 The Doors

注意两点之间线段最短，从 A (0,5) 到B（10,5）两点之间的最短距离一定是连接各个墙上的某些点组成的路径之和

1 注意 如果连接门上的两点要判断这两点之间是否有墙的存在，如果存在墙就不能连接，也就是没有路径，否则两点之间有路径，并计算保存两点之间的距离

2 这些点组成一个图，以后就可以用迪杰斯特拉求最短路径了

代码：

#include <iostream>
#include <cstdio>
#include <cstring>
#include <cmath>
using namespace std;
#define INF 10000000000
#define maxnum 1005
struct thewall
{
double x;
double y[4];
};
struct thenode
{
double x;
double y;
};
double map[maxnum][maxnum];//对应node上的点 map[i][j]点i到点j之间的距离为map[i[j]
thenode node[maxnum];//将所有的点包括(0,5) (10,5) 记录下拉
thewall wall[maxnum];//墙的记录
int sign[maxnum];
double task[maxnum];
int l;
int n;
int hasWll(int n1,int n2)
{
double k=(node[n1].y-node[n2].y)/(node[n1].x-node[n2].x);
double b=node[n1].y-k*node[n1].x;
int sign[maxnum];
memset(sign,0,sizeof(sign));
int i,j;
double x,y;
for(i=0;i<l;i++)
{
if(node[i].x>node[n1].x&&node[i].x<node[n2].x)
{
x=node[i].x;
y=k*x+b;
j=(i-1)/4;
if(j<0)
j=0;
if(!sign[j])
if((y>0&&y<wall[j].y[0])||(y>wall[j].y[1]&&y<wall[j].y[2])||(y>wall[j].y[3]&&y<10))
return 1;
}
}
return 0;
}
double getlength(int n1,int n2)
{
double d=sqrt((node[n1].x-node[n2].x)*(node[n1].x-node[n2].x)+(node[n1].y-node[n2].y)*(node[n1].y-node[n2].y));
return d;
}
double solve()//求最短路径迪杰斯特拉算法
{
memset(sign,0,sizeof(sign));
int i;
int u;
double min=INF;
for(i=0;i<l;i++)
task[i]=map[0][i];
while(!sign[l-1])
{
min=INF;
for(i=0;i<l;i++)
{
if(!sign[i]&&min>task[i])
{
min=task[i];
u=i;
}
}
if(min==INF)
break;
sign[u]=1;
for(i=0;i<l;i++)
{
if(!sign[i])
{
if(task[i]>task[u]+map[u][i])
task[i]=task[u]+map[u][i];
}
}
}
return task[l-1];


}
int main()
{
int i,j,k;
while(scanf("%d",&n)!=EOF)
{
if(n<0)
break;
l=n*4+2;
for(i=0;i<l;i++)
for(j=0;j<l;j++)
map[i][j]=INF;
j=0;
node[0].x=0;
node[0].y=5;
node[l-1].x=10;
node[l-1].y=5;
j=1;
for(i=0;i<n;i++)
{
scanf("%lf%lf%lf%lf%lf",&wall[i].x,&wall[i].y[0],&wall[i].y[1],&wall[i].y[2],&wall[i].y[3]);
for(k=0;k<4;k++)
{
node[j].x=wall[i].x;
node[j].y=wall[i].y[k];
j++;
}
}
double d;
for(i=0;i<l;i++)
{
for(j=i+1;j<l;j++)
if(map[i][j]==INF&&node[i].x!=node[j].x)
{
int t=hasWll(i,j);//判断点i 和j 之间是否有墙存在
if(!t)//如果不存在墙就连接两点，并求出两点之间的距离
{
d=getlength(i,j);
map[i][j]=d;
map[j][i]=map[i][j];
}
}
}
printf("%.2lf\n",solve());
}
return 0;
}