poj1556 The Doors 计算几何+最短路

题目链接：http://poj.org/problem?id=1556

//题目意思：在一个10*10的矩形内有几堵墙，求点（0，5）到（10，5）的最短路（不能穿墙而过）

//解题思路：记录每堵墙和可能要停留的点，构造（4*n+2）个点的图，求最短路。

//0ms AC代码 如下：

#include<iostream>
#include<cstdio>
#include<math.h>
#define  eps 1e-8
#define INF 1e8
struct Point{double x,y;};
bool zero(double x)
{
	return x>0? x<eps: x>-eps;
}
double xmult(Point p1,Point p2,Point p0)
{
	return (p1.x-p0.x)*(p2.y-p0.y)-(p1.y-p0.y)*(p2.x-p0.x);
}



bool opposite_side(Point p1,Point p2,Point p3,Point p4)
{
	return xmult(p3,p1,p4)*xmult(p3,p2,p4)<-eps;
}

bool intersect_ex(Point p1,Point p2,Point p3,Point p4)//线段相交，不包括端点
{
	return opposite_side(p1,p2,p3,p4)&&opposite_side(p3,p4,p1,p2);
}
double distance(Point p1,Point p2)
{
	return sqrt((p1.x-p2.x)*(p1.x-p2.x)+(p1.y-p2.y)*(p1.y-p2.y));
}
Point map[100000];
Point line[100000][6];
double f[100000];
bool d[100000];
int n;
double M[1000][1000];

void Dijkstra(int s,int e,int n);

bool judge(Point p1,Point p2,int n)//路线是否撞墙
{
	int k;
	for(k=0;k<n;k++)
	{
		if(intersect_ex(p1,p2,line[k][0],line[k][1]))break;
		if(intersect_ex(p1,p2,line[k][2],line[k][3]))break;
		if(intersect_ex(p1,p2,line[k][4],line[k][5]))break;
	}
	
	return   k==n;
}



int main()
{
	int n;
	while(scanf("%d",&n),n!=-1)
	{
		int i,j;
		for(i=0;i<4*n+2;i++)
		{
			for(j=0;j<4*n+2;j++)
			{
				if(i==j)M[i][j]=0;
				else M[i][j]=INF;
			}
		}
		map[0].x=0;map[0].y=5;
		for(i=0;i<n;i++)
		{
			double x;
			scanf("%lf%lf%lf%lf%lf",&x,&map[i*4+1].y,&map[i*4+2].y,&map[i*4+3].y,&map[i*4+4].y);
			line[i][0].x=line[i][1].x=line[i][2].x=line[i][3].x=line[i][4].x=line[i][5].x=x;
			line[i][0].y=0;line[i][5].y=10;
			map[i*4+1].x=map[i*4+2].x=map[i*4+3].x=map[i*4+4].x=x;
			line[i][1].y=map[i*4+1].y;
			line[i][2].y=map[i*4+2].y;
			line[i][3].y=map[i*4+3].y;
			line[i][4].y=map[i*4+4].y;
		}
		map[4*n+1].x=10;
		map[4*n+1].y=5;
		
		for(i=0;i<=4*n+1;i++)
		{
			for(j=i+1;j<=4*n+1;j++)
			{
				if(judge(map[i],map[j],n))
				{
					double dis=distance(map[i],map[j]);
					M[i][j]=M[j][i]=dis;
				}
			}
		}
		
		Dijkstra(0,4*n+1,4*n+2);
		printf("%.2lf\n",f[4*n+1]);
	}
	return 0;
}

void Dijkstra(int s,int e,int n)
{
    int i,j;
    int minj,min;
    for(i=0;i<n;i++)//初始化
    {
        f[i]=M[s][i];
        d[i]=1;
    }
    f[s]=0;
    for(i=0;i<n;i++)//用i条路
    {
        min=INF;
        for(j=0;j<n;j++)
        {
            if(d[j]!=0&&f[j]<min)
            {
                min=f[j];
                minj=j;
            }
        }
        d[minj]=0;
        for(j=0;j<n;j++)
        {
            if(d[j]!=0&&f[j]>f[minj]+M[minj][j])//之前决策点minj到j 和原来的j的比较
            {
                f[j]=f[minj]+M[minj][j];
            }
        }
    }
}