poj 1556

这道题目在黑皮书上有。思路很容易就想到，就是枚举每两个端点，判断两个点之间是否与墙相交，不想交的话则将路径距离加入矩阵中，相交的的话则赋值INF，然后就是一个求最短路径的问题，可以用dijkstra算法。
这道题麻烦在建图。

#include<stdio.h>
#include<math.h>
#define N 100
#define inf 0x3fffffff
struct node
{
	double x,y;
}p[N];
struct p
{
	node a,b;
}line[N];
double dist[N],map[N][N];
int mark[N],t;
double multi(node a,node b,node c)
{
	return ((a.x-c.x)*(b.y-c.y)-(a.y-c.y)*(b.x-c.x));
}
double distance(node a,node b)
{
	return sqrt((a.x-b.x)*(a.x-b.x)+(a.y-b.y)*(a.y-b.y));
}
double dijkstra()
{
	int i,j,u;
	double min;
	for(i=0;i<=t;i++)
	{
		dist[i]=inf;
		mark[i]=0;
	}
	dist[0]=0;
	for(i=0;i<=t;i++)
	{
		min=inf;
		for(j=0;j<=t;j++)
		{
			if(!mark[j]&&dist[j]<min)
			{
				min=dist[j];
				u=j;
			}
		}
		if(min==inf)
			break;
		mark[u]=1;
		for(j=0;j<=t;j++)
		{
			if(!mark[j]&&dist[j]>dist[u]+map[u][j])
				dist[j]=dist[u]+map[u][j];
		}
	}
	return dist[t];
}
int main()
{
	double t1,t2,x,y1,y2,y3,y4,t3,t4;
	int i,j,n,k;
	while(scanf("%d",&n),n!=-1)
	{
		t=4*n+1;
	   p[0].x=0;p[0].y=5;
       p[t].x=10;p[t].y=5;
		for(i=0;i<n;i++)
		{
		  scanf("%lf%lf%lf%lf%lf",&x,&y1,&y2,&y3,&y4);
		  p[i*4+1].x=x;p[i*4+1].y=y1;
          p[i*4+2].x=x;p[i*4+2].y=y2;
		  p[i*4+3].x=x;p[i*4+3].y=y3;
		  p[i*4+4].x=x;p[i*4+4].y=y4;
		  line[i*3].a.x=x;line[i*3].a.y=0; line[i*3].b.x=x;line[i*3].b.y=y1;
		  line[i*3+1].a.x=x;line[i*3+1].a.y=y2; line[i*3+1].b.x=x;line[i*3+1].b.y=y3;
		  line[i*3+2].a.x=x;line[i*3+2].a.y=y4; line[i*3+2].b.x=x;line[i*3+2].b.y=10;
		}
		for(i=0;i<=t;i++)
		{
			for(j=0;j<=t;j++)
			{
				if(i==j)
					map[i][j]=0;
				else
					map[i][j]=inf;
			}
		}
	  for(i=0;i<=t;i++)
	  {
		  for(j=i+1;j<=t;j++)
		  {
			  for(k=0;k<n*3;k++)
			  {
				  if(p[i].x!=p[j].x&&p[i].x!=line[k].a.x&&p[j].x!=line[k].a.x)
				  {//线段与线段是否相交
					  t1=multi(p[i],p[j],line[k].a);
					  t2=multi(p[i],p[j],line[k].b);
					  t3=multi(line[k].a,line[k].b,p[i]);//这里注意，判断相交的时候，双向判断。
                      t4=multi(line[k].a,line[k].b,p[j]);
					  if(t1*t2<=0&&t3*t4<=0)//两个条件都的满足
						  break;
				  }
			  }
			  if(k==n*3)
				  map[i][j]=distance(p[i],p[j]);
		  }
	  }
	  printf("%.2lf\n",dijkstra());
	}
	return 0;
}