poj 1556 The Doors

1556 The Doors

题意：有一个房间，中间有一些墙，每堵墙上有两个门，问从起点到终点的距离。

思路：要使距离最短，如果中间没有被挡住，直接一条线段。如果被挡住那么走得位置肯定是被挡住的端点。把每个端点当成一个点，然后求出任意两个可达端点之间的距离，再用dij就可以了。开始居然没想通怎么建图。其实很简单，

/* * File: main.cpp * Author: Mi * * Created on 2011年5月4日, 下午2:37 */ #include <stdio.h> #include <string.h> #include <algorithm> #include <math.h> #include <map> #include <vector> #include <stdlib.h> #define MAX 205 #define eps 1e-8 using namespace std; /* * */ struct Point { double x,y; }p[MAX],l[MAX][2]; int dblcmp(double d) { if(fabs(d)<eps) return 0; return d>0?1:-1; } double det(double x1,double y1,double x2,double y2)//area2 { return x1*y2-x2*y1; } double cross(Point a,Point b,Point c) { return det(b.x-a.x,b.y-a.y,c.x-a.x,c.y-a.y); } int segcross(Point a,Point b,Point c,Point d) { return (dblcmp(cross(a,c,d))^dblcmp(cross(b,c,d)))==-2&& (dblcmp(cross(c,a,b))^dblcmp(cross(d,a,b)))==-2; } double dislen(double x1,double y1,double x2,double y2) { return sqrt((x1-x2)*(x1-x2)+(y1-y2)*(y1-y2)); } double len[MAX][MAX],dis[MAX]; int s[MAX]; void dij(int x,int n) { memset(dis,0,sizeof(dis)); memset(s,0,sizeof(s)); int i,j,k; double min; for(i=0;i<=n;i++) dis[i]=len[x][i]; dis[x]=0; s[x]=1; for(i=0;i<=n-1;i++) { min=1e8; for(j=k=0;j<=n;j++) { if(s[j]!=1&&dis[j]<min) { k=j; min=dis[j]; } } s[k]=1; for(j=0;j<=n;j++) if(s[j]!=1&&dis[k]+len[k][j]<dis[j]) dis[j]=dis[k]+len[k][j]; } printf("%.2lf/n",dis[n]); } int main(int argc, char** argv) { int n,s,e; while(scanf("%d",&n)&&n!=-1) { s=0,e=4*n+1; p[s].x=0,p[s].y=5; p[e].x=10,p[e].y=5; for(int i=0;i<n;i++) { double x,y1,y2,y3,y4; scanf("%lf",&x); scanf("%lf%lf%lf%lf",&y1,&y2,&y3,&y4); p[i*4+1].x=p[i*4+2].x=p[i*4+3].x=p[i*4+4].x=x; p[i*4+1].y=y1; p[i*4+2].y=y2; p[i*4+3].y=y3; p[i*4+4].y=y4; l[i*3][0].x=l[i*3][1].x= l[i*3+1][0].x=l[i*3+1][1].x= l[i*3+2][0].x=l[i*3+2][1].x=x; l[i*3][0].y=0; l[i*3][1].y=y1; l[i*3+1][0].y=y2; l[i*3+1][1].y=y3; l[i*3+2][0].y=y4; l[i*3+2][1].y=10; } for(int i=0;i<=e;i++) for(int j=0;j<=e;j++) len[i][j]=1e6; for(int i=0;i<=e;i++)//建图 for(int k,j=i+1;j<=e;j++) { for(k=0;k<3*n;k++) if(p[i].x!=l[k][0].x&&p[j].x!=l[k][0].x&&segcross(p[i],p[j],l[k][0],l[k][1])) break; if(k>=3*n) len[i][j]=dislen(p[i].x,p[i].y,p[j].x,p[j].y); } dij(s,e); } return 0; }