这道题失球最短路径,结合了计算几何与图论的知识
#include<iostream>
#include<cstdio>
#include<cmath>
struct point
{
double x,y;
}p[200];
struct segment
{
point a,b;
}s[200];
double g[200][200];
int t;
//计算oa和ob的叉积
double cross(point a, point b, point o)
{
return (a.x-o.x)*(b.y-o.y)-(a.y-o.y)*(b.x-o.x);
}
//判断a大于0,小于0,还是等于0
int equal(double a)
{
if(fabs(a)<1e-6) return 0;
return a>0?1:-1;
}
//计算线段ab的长度
double dist2(point a, point b)
{
return sqrt((a.x-b.x)*(a.x-b.x)+(a.y-b.y)*(a.y-b.y));
}
//判断线段ab是否相交,若相交,则返回true
bool check(point a, point b, point c, point d)
{
return equal(cross(a,c,d))*equal(cross(b,c,d))<=0 && equal(cross(a,b,c))*equal(cross(a,b,d))<=0;
}
double Dijkstra()
{
int i,j;
double dist[200];
bool visited[200];
for(i=0;i<=t;i++)
{
dist[i]=1e10;
visited[i]=false;
}
dist[0]=0;
for(i=0;i<=t;i++)
{
double temp=1e10;
int index;
for( j=0;j<=t;j++)
{
if(! visited[j] && temp>dist[j])
{
index=j;
temp=dist[j];
}
}
if(temp==1e10)
{
break;
}
visited[index]=true;
for(j=0;j<=t;j++)
{
if(! visited[j] && dist[index]+g[index][j]<dist[j])
{
dist[j]=dist[index]+g[index][j];
}
}
}
return dist[t];
}
int main()
{
freopen("test.txt","r",stdin);
int n;
int i,j;
double ans;
while(scanf("%d",&n)!=EOF &&n!=-1 )
{
t=n*4+1;
p[0].x=0,p[0].y=5;
p[t].x=10,p[t].y=5;
for(i=0;i<n;i++)
{
double x,a,b,c,d;
scanf("%lf%lf%lf%lf%lf",&x,&a,&b,&c,&d);
p[i*4+1].x=x,p[i*4+1].y=a;
p[i*4+2].x=x,p[i*4+2].y=b;
p[i*4+3].x=x,p[i*4+3].y=c;
p[i*4+4].x=x,p[i*4+4].y=d;
s[i*3].a.x=x,s[i*3].a.y=0,s[i*3].b.x=x,s[i*3].b.y=a;
s[i*3+1].a.x=x,s[i*3+1].a.y=b,s[i*3+1].b.x=x,s[i*3+1].b.y=c;
s[i*3+2].a.x=x,s[i*3+2].a.y=d,s[i*3+2].b.x=x,s[i*3+2].b.y=10;
}
for(i=0;i<=t;i++)
{
for(j=0;j<=t;j++)
{
g[i][j]=1e10;
}
}
for(i=0;i<=t;i++)
{
for(j=i+1;j<=t;j++)
{
int k;
for(k=0;k<n*3;k++)
{
if(p[i].x!=p[j].x && p[i].x!=s[k].a.x && p[j].x!=s[k].a.x && check(p[i],p[j],s[k].a,s[k].b))
{
break;
}
}
if(k>=n*3) //p[i]p[j]不与s[k]中任何线段(p[i].x!=s[k].a.x 且 p[j].x!=s[k].a.x)相交
{
g[i][j]=dist2(p[i],p[j]);
}
}
}
ans=Dijkstra();
printf("%.2lf\n",ans);
}
return 0;
}