pku1556The Doors

题目：pku1556

方法：直线相交判断+dijkstra算法

思路：把每个门的两点看成图中的一个点，构造一个以两点距离为权值的图（如果不可直达，记为INF），

再用dijkstra算法求出两个端点点的最短路。

注意：不要用memset初始化g,d;用memset初始化为非0值时，其值并非我们想象的，尽管那值很稳定。

如定义一个数组long a[20];memset(a,1,sizeof(a));用一个循环语句将各元素输出，其值都一样。

但并不是1，而是16843009。

代码：

//0 <= n <= 30  

#include<iostream>
#include <algorithm>
#include<cmath>
using namespace std;

//Dijkstra算法模板开始
//==============================================
#define MAX 105
#define INF 0x11111111
#define TRUE 1
#define FALSE 0

typedef struct{
    //double info;
}VertexType;

typedef struct{
    double val;
    //double info;
}ArcType,ArcMatrix[MAX][MAX];

typedef struct{
    int vexnum;
    VertexType vexs[MAX];
    ArcMatrix arcs;
}MGraph;

typedef double ShortPathTable[MAX];

void ShortestPath_DIJ(MGraph &G,int v0, ShortPathTable &D)
{
    // 用Dijkstra算法求有向网G的v0顶点到其余顶点v的最短路径P[v]
    // 及其带权长度D[v]。
    // 若P[v][w]为TRUE，则w是从v0到v当前求得最短路径上的顶点。
    // final[v]为TRUE当且仅当v∈S,即已经求得从v0到v的最短路径。
    int i=0, v,w;
	double min;
    bool final[MAX];
    for (v=0; v<G.vexnum; ++v)
    {
        final[v] = FALSE; 
        D[v] = G.arcs[v0][v].val;
    }
    D[v0] = 0; final[v0] = TRUE;        // 初始化，v0顶点属于S集
    //--- 开始主循环，每次求得v0到某个v顶点的最短路径，并加v到S集 ---
    for (i=1; i<G.vexnum; ++i)           // 其余G.vexnum-1个顶点
    {
        min = INF;                  // 当前所知离v0顶点的最近距离
        for (w=0; w<G.vexnum; ++w)
            if (!final[w])                             // w顶点在V-S中
                if (D[w]<min) { v = w; min = D[w]; } // w顶点离v0顶点更近
        final[v] = TRUE;                       // 离v0顶点最近的v加入S集
        for (w=0; w<G.vexnum; ++w)             // 更新当前最短路径及距离
            if (!final[w] && (min+G.arcs[v][w].val<D[w])) { 
                // 修改D[w]和P[w], w∈V-S
                D[w] = min + G.arcs[v][w].val;
            }//if
    }//for
} // ShortestPath_DIJ
MGraph g;
ShortPathTable d;
//=========================================================

//判断线段相交、距离、差积的计算
//========================================================
struct point
{   double x,y;  }; 
struct line
{   point s, e;  };
double max(double a,double b)
{	return a>b?a:b;		}
double min(double a,double b)
{	return a<b?a:b;		}

//计算距离
double dist(point p1,point p2)
{   double x1=p1.x-p2.x,y1=p1.y-p2.y;
    return sqrt(x1*x1+y1*y1);  
}
//计算叉积
double multi(point p0,point p1,point p2)
{   return (p1.x-p0.x)*(p2.y-p0.y)-(p2.x-p0.x)*(p1.y-p0.y);}
//判断线段相交  差积有等于号时为非规范相交，无等号为规范相交
bool is_cross(point s1,point e1,point s2,point e2)
{
   return max(s1.x,e1.x)>=min(s2.x,e2.x)&&
          max(s2.x,e2.x)>=min(s1.x,e1.x)&&
          max(s1.y,e1.y)>=min(s2.y,e2.y)&&
          max(s2.y,e2.y)>=min(s1.y,e1.y)&&
          multi(s2,e1,s1)*multi(e1,e2,s1)>0&&
          multi(s1,e2,s2)*multi(e2,e1,s2)>0;
}
//============================================================

//0 < x < 10
//思路：把每个门的两点看成图中的一个点，构造一个以两点距离为权值的图（如果不可直达，记为INF），
//再用dijkstra算法求出两个端点点的最短路。
int main()
{
    int n;
	int i,j,k,s,t;
	double x,y1,y2,y3,y4,temp;
	line segment[60];
	point p[MAX];
	while(cin>>n)
	{
		if(n==-1)break;
		p[0].x=0;p[0].y=5;j=1;k=0;
		for(i=0;i<n;i++)
		{
			cin>>x>>y1>>y2>>y3>>y4;
			p[j].x=x;p[j].y=y1;j++;
			p[j].x=x;p[j].y=y2;j++;
			p[j].x=x;p[j].y=y3;j++;
			p[j].x=x;p[j].y=y4;j++;
			segment[k].s.x=x;segment[k].s.y=0;segment[k].e.x=x;segment[k].e.y=y1;k++;
			segment[k].s.x=x;segment[k].s.y=y2;segment[k].e.x=x;segment[k].e.y=y3;k++;
			segment[k].s.x=x;segment[k].s.y=y4;segment[k].e.x=x;segment[k].e.y=10;k++;
		}
		p[j].x=10;p[j].y=5;
		g.vexnum = j+1;
        //memset(g.arcs,INF,sizeof(g.arcs));
        //memset(d,INF,sizeof(d)); 
		for(i=0;i<=j;i++)
			for(s=0;s<=j;s++)
				g.arcs[i][s].val=INF;
		for(i=0;i<=j+1;i++)d[i]=INF;
		for(i=0;i<j;i++)
			for(s=i+1;s<=j;s++)
			{
				for(t=0;t<k;t++)
					 if(is_cross(p[i],p[s],segment[t].s,segment[t].e)&&p[i].x!=p[s].x)break;
				if(t==k)
				{
					temp=dist(p[i],p[s]);
					g.arcs[i][s].val=temp;
					g.arcs[s][i].val=temp;
				}
			}
		ShortestPath_DIJ(g,0,d);
        printf("%.2lf\n",d[j]);
	}  
    return 0;
}