●POJ 1556 The Doors(简单计算几何+最短路)

时间:2022-02-22 08:25:08

●赘述题目

10*10的房间内,有竖着的一些墙(不超过18个)。问从点(0,5)到(10,5)的最短路。

按照输入样例,输入的连续5个数,x,y1,y2,y3,y4,表示(x,0--y1),(x,y2--y3),(x,y4--10)是墙壁。

●题解

方法:建图(用到简单计算几何)+最短路

○记录下每个端点。

○包含起点,终点,以及每个墙的可以走的端点,如下图:

○然后枚举点,尝试两两组合连(线段)边,若该线不会撞在墙上,即不会与墙壁线段相交,就add_adge()。

效果图如下:

●POJ 1556 The Doors(简单计算几何+最短路)

如何判断呢? 计算几何呗。我用的方法如下,须同时满足两个条件:

●POJ 1556 The Doors(简单计算几何+最短路)

●代码

#include<cmath>
#include<cstdio>
#include<queue>
#include<cstring>
#include<iostream>
using namespace std;
const double eps=1e-8;
typedef pair<double,int> pii;
struct point{double x,y;}p[105];
struct seg{double x1,y1,x2,y2;}w[105];
struct vec{
double x,y;
double operator ^(const vec rtm) {return x*rtm.y-y*rtm.x;} //向量叉乘(模)
vec operator -(const vec rtm) {return (vec){x-rtm.x,y-rtm.y};}
}v1,v2,v3,v4,v5,v6,v7,v8;
struct edge{
int to; double co; int next;
}e[10005];
int head[105];
double d[105];
int n,dnt,snt,ent;
double dis(point a,point b) {return sqrt((a.x-b.x)*(a.x-b.x)+(a.y-b.y)*(a.y-b.y));}
int sign(double a)
{
if(fabs(a)<eps) return 0;
return a>0?1:-1;
}
void add(int u,int v,double c)
{
e[ent]=(edge){v,c,head[u]};head[u]=ent++;
e[ent]=(edge){u,c,head[v]};head[v]=ent++;
}
void dijkstra()
{
for(int i=1;i<=dnt;i++) d[i]=1e7+9;
priority_queue<pii> q;
q.push((pii){0,1});d[1]=0;
while(!q.empty())
{
pii u=q.top();q.pop();
if(d[u.second]<u.first) continue;
for(int i=head[u.second];i!=-1;i=e[i].next)
{
int v=e[i].to;
if(d[v]>d[u.second]+e[i].co)
{
d[v]=d[u.second]+e[i].co;
q.push((pii){d[v],v});
}
}
}
}
int main()
{
p[++dnt]=(point){0,5}; p[++dnt]=(point){10,5};
while(1)
{
memset(head,-1,sizeof(head));
dnt=2;snt=0;ent=0;
scanf("%d",&n);
if(n==-1) break;
double x,y1,y2,y3,y4;
for(int i=1;i<=n;i++)
{
scanf("%f%f%f%f%f",&x,&y1,&y2,&y3,&y4);
p[++dnt]=(point){x,y1}; p[++dnt]=(point){x,y2}; p[++dnt]=(point){x,y3}; p[++dnt]=(point){x,y4};
w[++snt]=(seg){x,0,x,y1}; w[++snt]=(seg){x,y2,x,y3}; w[++snt]=(seg){x,y4,x,10};
}
bool fg;
for(int i=1;i<dnt;i++) for(int j=i+1;j<=dnt;j++)
{
fg=1;
for(int k=1;k<=snt;k++)
{
v1=(vec){p[i].x-w[k].x1,p[i].y-w[k].y1};
v2=(vec){p[i].x-w[k].x2,p[i].y-w[k].y2};
v3=(vec){p[j].x-w[k].x1,p[j].y-w[k].y1};
v4=(vec){p[j].x-w[k].x2,p[j].y-w[k].y2}; v5=(vec){0,0}-v1;
v6=(vec){0,0}-v3;
v7=(vec){0,0}-v2;
v8=(vec){0,0}-v4;
if(sign((v1^v2)*(v3^v4))<0&&(sign(v5^v6)*(v7^v8))<0) {fg=0;break;}
}
if(fg) add(i,j,dis(p[i],p[j]));
}
dijkstra();
printf("%.2f\n",d[2]);
}
return 0;
}