注意兩點之間線段最短，從 A (0,5) 到B（10,5）兩點之間的最短距離一定是連接各個牆上的某些點組成的路徑之和
1 注意 如果連接門上的兩點要判斷這兩點之間是否有牆的存在，如果存在牆就不能連接，也就是沒有路徑，否則兩點之間有路徑，並計算保存兩點之間的距離
2 這些點組成一個圖，以後就可以用迪傑斯特拉求最短路徑了
代碼：
#include <iostream>
#include <cstdio>
#include <cstring>
#include <cmath>
using namespace std;
#define INF 10000000000
#define maxnum 1005
struct thewall
{
double x;
double y[4];
};
struct thenode
{
double x;
double y;
};
double map[maxnum][maxnum];//對應node上的點 map[i][j]點i到點j之間的距離爲map[i[j]
thenode node[maxnum];//將所有的點包括(0,5) (10,5) 記錄下拉
thewall wall[maxnum];//牆的記錄
int sign[maxnum];
double task[maxnum];
int l;
int n;
int hasWll(int n1,int n2)
{
double k=(node[n1].y-node[n2].y)/(node[n1].x-node[n2].x);
double b=node[n1].y-k*node[n1].x;
int sign[maxnum];
memset(sign,0,sizeof(sign));
int i,j;
double x,y;
for(i=0;i<l;i++)
{
if(node[i].x>node[n1].x&&node[i].x<node[n2].x)
{
x=node[i].x;
y=k*x+b;
j=(i-1)/4;
if(j<0)
j=0;
if(!sign[j])
if((y>0&&y<wall[j].y[0])||(y>wall[j].y[1]&&y<wall[j].y[2])||(y>wall[j].y[3]&&y<10))
return 1;
}
}
return 0;
}
double getlength(int n1,int n2)
{
double d=sqrt((node[n1].x-node[n2].x)*(node[n1].x-node[n2].x)+(node[n1].y-node[n2].y)*(node[n1].y-node[n2].y));
return d;
}
double solve()//求最短路徑迪傑斯特拉算法
{
memset(sign,0,sizeof(sign));
int i;
int u;
double min=INF;
for(i=0;i<l;i++)
task[i]=map[0][i];
while(!sign[l-1])
{
min=INF;
for(i=0;i<l;i++)
{
if(!sign[i]&&min>task[i])
{
min=task[i];
u=i;
}
}
if(min==INF)
break;
sign[u]=1;
for(i=0;i<l;i++)
{
if(!sign[i])
{
if(task[i]>task[u]+map[u][i])
task[i]=task[u]+map[u][i];
}
}
}
return task[l-1];
}
int main()
{
int i,j,k;
while(scanf("%d",&n)!=EOF)
{
if(n<0)
break;
l=n*4+2;
for(i=0;i<l;i++)
for(j=0;j<l;j++)
map[i][j]=INF;
j=0;
node[0].x=0;
node[0].y=5;
node[l-1].x=10;
node[l-1].y=5;
j=1;
for(i=0;i<n;i++)
{
scanf("%lf%lf%lf%lf%lf",&wall[i].x,&wall[i].y[0],&wall[i].y[1],&wall[i].y[2],&wall[i].y[3]);
for(k=0;k<4;k++)
{
node[j].x=wall[i].x;
node[j].y=wall[i].y[k];
j++;
}
}
double d;
for(i=0;i<l;i++)
{
for(j=i+1;j<l;j++)
if(map[i][j]==INF&&node[i].x!=node[j].x)
{
int t=hasWll(i,j);//判斷點i 和j 之間是否有牆存在
if(!t)//如果不存在牆就連接兩點，並求出兩點之間的距離
{
d=getlength(i,j);
map[i][j]=d;
map[j][i]=map[i][j];
}
}
}
printf("%.2lf\n",solve());
}
return 0;
}