NOIP-2017提高组2-奶酪★★★★★

题目描述

现有一块大奶酪，它的高度为 h，它的长度和宽度我们可以认为是无限大的，奶酪中间有许多半径相同的球形空洞。我们可以在这块奶酪中建立空间坐标系，在坐标系中，奶酪的下表面为z = 0，奶酪的上表面为z = h。
现在，奶酪的下表面有一只小老鼠 Jerry，它知道奶酪中所有空洞的球心所在的坐标。如果两个空洞相切或是相交，则 Jerry 可以从其中一个空洞跑到另一个空洞，特别地，如果一个空洞与下表面相切或是相交，Jerry则可以从奶酪下表面跑进空洞;如果一个空洞与上表面相切或是相交，Jerry 则可以从空洞跑到奶酪上表面。
位于奶酪下表面的 Jerry 想知道，在不破坏奶酪的情况下，能否利用已有的空洞跑到奶酪的上表面去?
空间内两点P(x ,y ,z )、P(x ,y ,z )的距离公式如下:

输入

输入文件名为 cheese.in。
每个输入文件包含多组数据。
输入文件的第一行，包含一个正整数 T，代表该输入文件中所含的数据组数。
接下来是 T 组数据，每组数据的格式如下:
第一行包含三个正整数 n，h 和 r，两个数之间以一个空格分开，分别代表奶酪中空洞的数量，奶酪的高度和空洞的半径。
接下来的 n 行，每行包含三个整数 x、y、z，两个数之间以一个空格分开，表示空洞球心坐标为(x, y, z)。

输出

输出文件名为 cheese.out。
输出文件包含 T 行，分别对应 T 组数据的答案，如果在第 i 组数据中，Jerry 能从下表面跑到上表面，则输出“Yes”，如果不能，则输出“No”(均不包含引号)。

样例输入

3 
2 4 1 
0 0 1 
0 0 3 
2 5 1 
0 0 1 
0 0 4 
2 5 2 
0 0 2 
2 0 4

样例输出

Yes
No
Yes

#include <bits/stdc++.h>
using namespace std;
const int Max=1010;
int t,n,h,r,flag,father[Max];
struct shu{long long x,y,z;};
shu a[Max];
inline int get_int()
{
   int x=0,f=1;
   char c;
   for(c=getchar();(!isdigit(c))&&(c!='-');c=getchar());
   if(c=='-') {f=-1;c=getchar();}
   for(;isdigit(c);c=getchar()) x=(x<<3)+(x<<1)+c-'0';
   return x*f;
}
inline bool comp(const shu &a,const shu &b){return a.z<b.z;}
inline double calc(int i,int j){return sqrt(double(a[i].x-a[j].x)*(a[i].x-a[j].x)+(a[i].y-a[j].y)*(a[i].y-a[j].y)+(a[i].z-a[j].z)*(a[i].z-a[j].z));}
inline int getfather(int v){return father[v]==v ? v : father[v]=getfather(father[v]);}
int main()
{
   t=get_int();
   while(t--)
   {
     memset(a,0,sizeof(a));
     n=get_int(),h=get_int(),r=get_int();
     for(int i=1;i<=n;i++) a[i].x=get_int(),a[i].y=get_int(),a[i].z=get_int();
     sort(a+1,a+n+1,comp);
     for(int i=1;i<=n;i++) father[i]=i;
     if(a[n].z+r<h || a[1].z>r) {cout<<"No\n";continue;}
     for(int i=1;i<=n;i++)
       for(int j=i+1;j<=n;j++)
         if(calc(i,j)<=2*r)
         {
           int fax=getfather(i),fay=getfather(j);
           if(fax!=fay) father[fay]=fax;
         }
     flag=0;
     for(int i=n;i>=1;i--)
     {
       if(flag) break;
       if(a[i].z+r<h || flag) break;
       for(int j=1;j<=n;j++)
       {
         if(a[j].z>r) break;
         if(getfather(j)==getfather(i)&&a[j].z+r>=0) {flag=1;break;}
       }
     }
     cout<<(flag ? "Yes\n" : "No\n");
   }
  
   return 0;
}