UVA1001 Say Cheese （dijkstra）

如果没有洞，那么任意两点的最短距离就是直线距离，洞里是瞬间的，所以看成一个点就行了（其实点也可以当作半径为0的洞来处理），洞到洞的最短距离都是圆心距离减去半径。剩下的就是求单源最短路径，是完全图，用不加堆优化的dijkstra就行了O(n^2)。

#include<bits/stdc++.h>
using namespace std;
 
typedef long long ll;
 
const int maxn = ;
 
int x[maxn],y[maxn],z[maxn],r[maxn];
 
double g[maxn][maxn];
inline ll squ(ll x) { return x*x; }
inline double dist(int i,int j) { return sqrt(squ(x[i]-x[j])+squ(y[i]-y[j])+squ(z[i]-z[j]))-r[i]-r[j]; }
 
double d[maxn];
double INF = 1e9;
bool vis[maxn];
 
double dijkstra(int n,int s = ,int t = )
{
    for(int i = ; i < n; i++) d[i] = INF;
    memset(vis,,sizeof(bool)*n);
    for(int i = ; i < n; i++){
        int x; double m = INF;
        for(int y = ; y < n; y++) if(!vis[y] && d[y] < m) m = d[x = y];
        if(x == t) return d[t];
        vis[x] = true;
        for(int y = ; y < n; y++) d[y] = min(d[y],d[x]+g[x][y]);
    }
    return INF;
}
 
int main()
{
    //freopen("in.txt","r",stdin);
    int n,kas = ;
    while(scanf("%d",&n),~n){
        n += ;
        for(int i = ; i < n; i++) scanf("%d%d%d%d",x+i,y+i,z+i,r+i);
        scanf("%d%d%d%d%d%d",x,y,z,x+,y+,z+);
        for(int i = ; i < n; i++)
            for(int j = i+; j < n; j++){
                g[i][j] = max(.,dist(i,j));
                g[j][i] = g[i][j];
            }
        printf("Cheese %d: Travel time = %.0lf sec\n",++kas,dijkstra(n)*);
    }
    return ;
}