poj1556 The Doors(建图spfa+判断线段交)

我们把起点和终点，还有所有的线段端点连起来跑最短路即可。两点之间连线段时要判断是否合法，即是否与之间的墙相交。怎么判断呢，直接算斜率什么的会有很大的误差，还可能出现除0的情况很讨厌，因此百度一下向量叉积判断线段相交。看得我都晕了。嗯。下次看到大概还是不会。

#include <cstdio>
#include <cstring>
#include <algorithm>
#include <queue>
#include <cmath>
using namespace std;
#define N 100
#define ll long long
#define inf 0x3f3f3f3f
inline int read(){
    int x=0,f=1;char ch=getchar();
    while(ch<'0'||ch>'9'){if(ch=='-')f=-1;ch=getchar();}
    while(ch>='0'&&ch<='9') x=x*10+ch-'0',ch=getchar();
    return x*f;
}
int n,tot,h[N],num=0;
double d[N];
bool inq[N];
struct edge{
    int to,next;double val;
}data[N*N];
struct node{
    double x,y[5];
}a[N];
struct point{
    double x,y;
    friend point operator-(point a,point b){
        point res;res.x=a.x-b.x;res.y=a.y-b.y;return res;
    }
};
double cmul(point a,point b){//叉乘
    return a.x*b.y-a.y*b.x;
}
bool cross(point A,point B,point C,point D){//判断线段AB与CD是否相交 
    if(cmul(C-A,C-B)*cmul(D-A,D-B)>=0) return 0;
    if(cmul(A-C,A-D)*cmul(B-C,B-D)>=0) return 0;
    return 1;
}
inline bool jud(int st,int ed,double x1,double y1,double x2,double y2){
    point A,B,C,D;
    A.x=x1;A.y=y1;B.x=x2;B.y=y2;
    for(int i=st;i<=ed;++i){
        C.x=a[i].x;C.y=a[i].y[1];D.x=a[i].x;D.y=0;
        if(cross(A,B,C,D)) return 0;
        C.y=a[i].y[2];D.y=a[i].y[3];if(cross(A,B,C,D)) return 0;
        C.y=a[i].y[4];D.y=10;if(cross(A,B,C,D)) return 0;
    }return 1;
}
inline void add(int x,int y,double val){
    data[++num].to=y;data[num].next=h[x];h[x]=num;data[num].val=val;
}
void spfa(){
    queue<int>q;memset(d,127,sizeof(d));
    q.push(0);d[0]=0;inq[0]=1;
    while(!q.empty()){
        int x=q.front();inq[x]=0;q.pop();
        for(int i=h[x];i;i=data[i].next){
            int y=data[i].to;
            if(d[x]+data[i].val<d[y]){
                d[y]=d[x]+data[i].val;
                if(!inq[y]) inq[y]=1,q.push(y);
            }
        }
    }
}
int main(){
//  freopen("a.in","r",stdin);
    while(1){
        n=read();if(n==-1) break;tot=1;memset(h,0,sizeof(h));num=0;
        for(int i=1;i<=n;++i){
            scanf("%lf%lf%lf%lf%lf",&a[i].x,&a[i].y[1],&a[i].y[2],&a[i].y[3],&a[i].y[4]);
            add((i-1<<2)+1,(i-1<<2)+2,a[i].y[2]-a[i].y[1]);
            add((i-1<<2)+3,(i-1<<2)+4,a[i].y[4]-a[i].y[3]);
            add((i-1<<2)+2,(i-1<<2)+1,a[i].y[2]-a[i].y[1]);
            add((i-1<<2)+4,(i-1<<2)+3,a[i].y[4]-a[i].y[3]);
        }   
        for(int i=1;i<=n;++i){
            for(int j=1;j<=4;++j)
                if(jud(1,i-1,0,5,a[i].x,a[i].y[j])) add(0,(i-1<<2)+j,sqrt(a[i].x*a[i].x+(a[i].y[j]-5)*(a[i].y[j]-5)));  
        }
        if(jud(1,n,0,5,10,5)) add(0,4*n+1,10.0);
        for(int i=1;i<=n;++i)
            for(int j=1;j<=4;++j){
                for(int ii=i+1;ii<=n;++ii)
                    for(int jj=1;jj<=4;++jj)
                        if(jud(i+1,ii-1,a[i].x,a[i].y[j],a[ii].x,a[ii].y[jj])) add((i-1<<2)+j,(ii-1<<2)+jj,sqrt((a[i].x-a[ii].x)*(a[i].x-a[ii].x)+(a[i].y[j]-a[ii].y[jj])*(a[i].y[j]-a[ii].y[jj])));
                if(jud(i+1,n,a[i].x,a[i].y[j],10,5)) add((i-1<<2)+j,4*n+1,sqrt((a[i].x-10)*(a[i].x-10)+(a[i].y[j]-5)*(a[i].y[j]-5)));
            }
        spfa();
        printf("%.2f\n",d[4*n+1]);
    }
    return 0;
}