The Doors--poj1556(最短路+判断点与线段的关系)

http://poj.org/problem?id=1556

题目大意：从（0,5）走到（10,5）走的最短距离是多少

中间有最多18个隔着的墙  每个墙都有两个门  你只能从门通过

我的思路是  只要这两个点把能过的   就把他们的距离算出来  最后用迪杰斯塔拉算法求最短路就行了

#include<stdio.h>
#include<string.h>
#include<stdlib.h>
#include<ctype.h>
#include<math.h>
#include<algorithm>
#include<iostream>

using namespace std;
#define N 200
const double ESP = 1e-;
#define INF 0xffffffff
int vis[N];
double dis[N];
struct node
{
    double x,y;
    int c;
    node(double x=,double y=,int c=):x(x),y(y),c(c){}
}p[N];
node a[N][];

double G[N][N];

double dij(int s,int e)
{
    memset(vis,,sizeof(vis));
    for(int i=;i<e;i++)
    {
        dis[i]=G[s][i];
    }
    for(int i=;i<e;i++)
    {
        double Min=INF;
        int dist;
        for(int j=;j<e;j++)
        {
            if(!vis[j] && Min>dis[j])
            {
                Min=dis[j];
                dist=j;
            }
        }
        vis[dist]=;
        for(int j=;j<e;j++)
        {
            if(!vis[j])
                dis[j]=min(dis[j],dis[dist]+G[dist][j]);
        }
    }
    return dis[e-];
}

int main()
{
    int n;
    double k[N];
    while(scanf("%d",&n),n!=-)
    {
        p[]=node(,,);
        int b=;
        for(int i=;i<=n;i++)
        {
            scanf("%lf",&k[i]);
            scanf("%lf %lf %lf %lf",&a[i][].x,&a[i][].y,&a[i][].x,&a[i][].y);
            p[b++]=node(k[i],a[i][].x,i);
            p[b++]=node(k[i],a[i][].y,i);
            p[b++]=node(k[i],a[i][].x,i);
            p[b++]=node(k[i],a[i][].y,i);
        }
        p[b++]=node(,,n+);
        for(int i=;i<b;i++)
        {
            for(int j=;j<b;j++)
            {
                G[i][j]=INF;
            }
            dis[i]=INF;
        }
        for(int i=;i<b;i++)
        {
            for(int j=i+;j<b;j++)
            {
                if(p[i].c == p[j].c)
                    continue;
                int flag=;
                for(int l=p[j].c-; l>p[i].c; l--)
                {
                    double y=(k[l]-p[i].x)*(p[j].y-p[i].y)/(p[j].x-p[i].x)+p[i].y;
                    if(a[l][].x-y>ESP || (a[l][].y-y<ESP && a[l][].x-y>ESP) || (a[l][].y-y<ESP))
                    {
                        flag=;
                        break;
                    }
                }
                if(flag==)
                {
                    G[i][j]=sqrt((p[j].x-p[i].x)*(p[j].x-p[i].x)+(p[j].y-p[i].y)*(p[j].y-p[i].y));
                }
            }
        }
        double  aa=dij(,b);
        printf("%.2f\n",aa);
    }
    return ;
}