POJ 1556

枚举每两点的直线，看连线中是否存在线段交点，若存在，即这两点的直线不存在。建图，DIJK就可以了。

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

const int Max=100;
const int M=3000;
const int inf=10000;
typedef struct pt{
    double x,y;
    int belong;
}Point;

typedef struct pl{
    Point start,end;
}Pleg;
int how_point,how_pleg;
Point pot[Max];
Pleg edge[Max];

double multi(Point p1, Point p2,Point p0){
    return (p1.x-p0.x)*(p2.y-p0.y)-(p2.x-p0.x)*(p1.y-p0.y);
}
int head[Max],tot;
struct {
    int u,v;
    double w;
    int next;
}de[M];
double dis[Max];
bool vis[Max];

bool tested(Pleg v1,Point s,Point t){
    Pleg v2; v2.start=s; v2.end=t;
    if(max(v1.start.x,v1.end.x)>=min(v2.start.x,v2.end.x)&&
       max(v2.start.x,v2.end.x)>=min(v1.start.x,v1.end.x)&&
       max(v1.start.y,v1.end.y)>=min(v2.start.y,v2.end.y)&&
       multi(v2.start,v1.end,v1.start)*multi(v1.end,v2.end,v1.start)>0&&
       multi(v1.start,v2.end,v2.start)*multi(v2.end,v1.end,v2.start)>0)
       return false;
       return true;
}

void addedge(int u,int v,double w){
    de[tot].u=u;
    de[tot].v=v;
    de[tot].w=w;
    de[tot].next=head[u];
    head[u]=tot++;
}

void dijk(int s,int t){
    vis[s]=true; dis[s]=0;
    for(int i=head[s];i!=-1;i=de[i].next){
        int v=de[i].v;
        if(dis[v]>de[i].w)
        dis[v]=de[i].w;
    }
    for(int i=0;i<=how_point;i++){
        int p=s; double min=inf;
        for(int j=0;j<=how_point;j++){
            if(dis[j]<min&&!vis[j]){
                min=dis[j]; p=j;
            }
        }
        if(p==s) return ;
        vis[p]=true;
        for(int k=head[p];k!=-1;k=de[k].next){
            int v=de[k].v;
            if(min+de[k].w<dis[v]&&!vis[v]){
                dis[v]=min+de[k].w;
            }
        }
    }
}

int main(){
    pot[0].x=0; pot[0].y=5;
    int n; double a,b,c,d,e; Point tmp;
    while(scanf("%d",&n)!=EOF){
        if(n==-1) break;
        how_pleg=0;how_point=0;
        memset(head,-1,sizeof(head)); tot=0;
        memset(vis,false,sizeof(vis));
        for(int i=0;i<Max;i++)
        dis[i]=inf;
        for(int i=1;i<=n;i++){
            scanf("%lf%lf%lf%lf%lf",&a,&b,&c,&d,&e);
            how_pleg++;    how_point++;
            tmp.x=a; tmp.y=0; tmp.belong=how_pleg;
            pot[how_point].x=a; pot[how_point].y=b; pot[how_point].belong=how_pleg;
            edge[how_pleg].start=tmp; edge[how_pleg].end=pot[how_point];
            how_point++; how_pleg++;
            pot[how_point].x=a; pot[how_point].y=c; pot[how_point].belong=how_pleg;
            how_point++;
            pot[how_point].x=a; pot[how_point].y=d; pot[how_point].belong=how_pleg;
            edge[how_pleg].start=pot[how_point-1]; edge[how_pleg].end=pot[how_point];
            how_point++;  how_pleg++;
            pot[how_point].x=a; pot[how_point].y=e; pot[how_point].belong=how_pleg;
            tmp.x=a; tmp.y=10; tmp.belong=how_pleg;
            edge[how_pleg].start=pot[how_point]; edge[how_pleg].end=tmp;
        }
        how_point++;
        pot[how_point].x=10; pot[how_point].y=5;pot[how_point].belong=how_pleg+1;
        for(int i=0;i<=how_point;i++){
            for(int j=i+1;j<=how_point;j++){
                int e=pot[j].belong;
                bool flag=true;
                for(int k=1;k<e;k++){
                    if(!tested(edge[k],pot[i],pot[j])){
                        flag=false;
                        break;
                    }
                }
                if(flag){
                    double x=pot[i].x-pot[j].x;
                    double y=pot[j].y-pot[i].y;
                    double d=sqrt(x*x+y*y);
                    addedge(i,j,d);
                }
            }
        }
        dijk(0,how_point);
        printf("%0.2lf
",dis[how_point]);
    }
}