poj2349最小生成树prim

#include<iostream>
#include<cmath>
#include<cstring>
#include<cstdio>
#include<cstdlib>
#include<algorithm>
#define inf 1<<29
using namespace std;
int n,s,p,x[510],y[510];
double dis[510][510],ans[510];
void prim()
{
    bool hh[510];
    int v;
    for(int i=1;i<=p;i++)
    {
        ans[i]=dis[1][i];
        hh[i]=0;            
    }          
    for(int i=1;i<=p
    ;i++)
    {
        int mi=inf;
        for(int j=1;j<=p;j++)
        {
            if(ans[j]<mi&&!hh[j]) {mi=ans[j];v=j;}        
        }        
        hh[v]=1;
        for(int j=1;j<=p;j++)
        {
            if(!hh[j]&&dis[v][j]<ans[j]) ans[j]=dis[v][j];        
        }
        
    }
}
int main()
{
    scanf("%d",&n);
    while(n--)
    {
        scanf("%d%d",&s,&p);          
        for(int i=1;i<=p;i++) scanf("%d%d",&x[i],&y[i]);
        for(int i=1;i<=p;i++)
        {
            for(int j=1;j<=p;j++)
            {
                dis[i][j]=sqrt((double)(x[i]-x[j])*(double)(x[i]-x[j])+(double)(y[i]-y[j])*(double)(y[i]-y[j]));              
            }        
        }      
        prim();
        sort(ans+1,ans+p+1);
        printf("%.2f\n",ans[p-s+1]);       
    }

    return 0;
}