POJ 1556
枚举每两点的直线，看连线中是否存在线段交点，若存在，即这两点的直线不存在。建图，DIJK就可以了。
1 #include <iostream> 2 #include <cstdio> 3 #include <cstring> 4 #include <cmath> 5 #include <algorithm> 6 using namespace std; 7 8 const int Max=100; 9 const int M=3000; 10 const int inf=10000; 11 typedef struct pt{ 12 double x,y; 13 int belong; 14 }Point; 15 16 typedef struct pl{ 17 Point start,end; 18 }Pleg; 19 int how_point,how_pleg; 20 Point pot[Max]; 21 Pleg edge[Max]; 22 23 double multi(Point p1, Point p2,Point p0){ 24 return (p1.x-p0.x)*(p2.y-p0.y)-(p2.x-p0.x)*(p1.y-p0.y); 25 } 26 int head[Max],tot; 27 struct { 28 int u,v; 29 double w; 30 int next; 31 }de[M]; 32 double dis[Max]; 33 bool vis[Max]; 34 35 bool tested(Pleg v1,Point s,Point t){ 36 Pleg v2; v2.start=s; v2.end=t; 37 if(max(v1.start.x,v1.end.x)>=min(v2.start.x,v2.end.x)&& 38 max(v2.start.x,v2.end.x)>=min(v1.start.x,v1.end.x)&& 39 max(v1.start.y,v1.end.y)>=min(v2.start.y,v2.end.y)&& 40 multi(v2.start,v1.end,v1.start)*multi(v1.end,v2.end,v1.start)>0&& 41 multi(v1.start,v2.end,v2.start)*multi(v2.end,v1.end,v2.start)>0) 42 return false; 43 return true; 44 } 45 46 void addedge(int u,int v,double w){ 47 de[tot].u=u; 48 de[tot].v=v; 49 de[tot].w=w; 50 de[tot].next=head[u]; 51 head[u]=tot++; 52 } 53 54 void dijk(int s,int t){ 55 vis[s]=true; dis[s]=0; 56 for(int i=head[s];i!=-1;i=de[i].next){ 57 int v=de[i].v; 58 if(dis[v]>de[i].w) 59 dis[v]=de[i].w; 60 } 61 for(int i=0;i<=how_point;i++){ 62 int p=s; double min=inf; 63 for(int j=0;j<=how_point;j++){ 64 if(dis[j]<min&&!vis[j]){ 65 min=dis[j]; p=j; 66 } 67 } 68 if(p==s) return ; 69 vis[p]=true; 70 for(int k=head[p];k!=-1;k=de[k].next){ 71 int v=de[k].v; 72 if(min+de[k].w<dis[v]&&!vis[v]){ 73 dis[v]=min+de[k].w; 74 } 75 } 76 } 77 } 78 79 int main(){ 80 pot[0].x=0; pot[0].y=5; 81 int n; double a,b,c,d,e; Point tmp; 82 while(scanf("%d",&n)!=EOF){ 83 if(n==-1) break; 84 how_pleg=0;how_point=0; 85 memset(head,-1,sizeof(head)); tot=0; 86 memset(vis,false,sizeof(vis)); 87 for(int i=0;i<Max;i++) 88 dis[i]=inf; 89 for(int i=1;i<=n;i++){ 90 scanf("%lf%lf%lf%lf%lf",&a,&b,&c,&d,&e); 91 how_pleg++; how_point++; 92 tmp.x=a; tmp.y=0; tmp.belong=how_pleg; 93 pot[how_point].x=a; pot[how_point].y=b; pot[how_point].belong=how_pleg; 94 edge[how_pleg].start=tmp; edge[how_pleg].end=pot[how_point]; 95 how_point++; how_pleg++; 96 pot[how_point].x=a; pot[how_point].y=c; pot[how_point].belong=how_pleg; 97 how_point++; 98 pot[how_point].x=a; pot[how_point].y=d; pot[how_point].belong=how_pleg; 99 edge[how_pleg].start=pot[how_point-1]; edge[how_pleg].end=pot[how_point]; 100 how_point++; how_pleg++; 101 pot[how_point].x=a; pot[how_point].y=e; pot[how_point].belong=how_pleg; 102 tmp.x=a; tmp.y=10; tmp.belong=how_pleg; 103 edge[how_pleg].start=pot[how_point]; edge[how_pleg].end=tmp; 104 } 105 how_point++; 106 pot[how_point].x=10; pot[how_point].y=5;pot[how_point].belong=how_pleg+1; 107 for(int i=0;i<=how_point;i++){ 108 for(int j=i+1;j<=how_point;j++){ 109 int e=pot[j].belong; 110 bool flag=true; 111 for(int k=1;k<e;k++){ 112 if(!tested(edge[k],pot[i],pot[j])){ 113 flag=false; 114 break; 115 } 116 } 117 if(flag){ 118 double x=pot[i].x-pot[j].x; 119 double y=pot[j].y-pot[i].y; 120 double d=sqrt(x*x+y*y); 121 addedge(i,j,d); 122 } 123 } 124 } 125 dijk(0,how_point); 126 printf("%0.2lf\n",dis[how_point]); 127 } 128 }
