奶酪

题目描述
现有一块大奶酪，它的高度为 h ，它的长度和宽度我们可以认为是无限大的，奶酪中间有许多半径相同的球形空洞。我们可以在这块奶酪中建立空间坐标系，在坐标系中，奶酪的下表面为 z = 0 ，奶酪的上表面为 z = h 。

现在，奶酪的下表面有一只小老鼠 Jerry ，它知道奶酪中所有空洞的球心所在的坐标。如果两个空洞相切或是相交，则 Jerry 可以从其中一个空洞跑到另一个空洞，特别地，如果一个空洞与下表面相切或是相交， Jerry 则可以从奶酪下表面跑进空洞；如果一个空洞与上表面相切或是相交， Jerry 则可以从空洞跑到奶酪上表面。

位于奶酪下表面的 Jerry 想知道，在不破坏奶酪的情况下，能否利用已有的空洞跑到奶酪的上表面去 ?

P1(x1,y1,z1)、P2(x2,y2,z2)的距离公式如下：

1<=n<=1000,1<=h,r<=1000000000,T<=20 坐标绝对值不超过1000000000

输入
包含多组数据。
第一行，包含一个正整数 T，代表该输入文件中所含的数据组数。
接下来是 T 组数据，每组数据的格式如下：
第一行包含三个正整数 n，h 和 r，两个数之间以一个空格分开，分别代表奶酪中空洞的数量，奶酪的高度和空洞的半径。
接下来的 n 行，每行包含三个整数 x、y、z，两个数之间以一个空格分开，表示空洞球心坐标为(x,y,z)
输出
输出包含T行，分别对应T组数据的答案，如果在第i组数据中，Jerry能从下表面跑到上表面，则输出Yes，如果不能，则输出No（均不包含引号）。
样例输入 Copy
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
样例输出 Copy
Yes
No
Yes

思路：使用dfs， 搜索和当前节点的距离小于r的结点， 如果最后搜索到了最上面的顶点，那么就可以走到

#include<vector>
#include<algorithm>
#include<iostream>
#include<cmath>
#include<cstring>
using namespace std;
const int N = 1e5 + 10;
bool st[N];
int n, h, r;
bool flag = 0;
struct node
{
    double x, y, z;
    bool operator < (const node & a)const
    {
        return z < a.z;
    }
} e[N];
double dis(node aa, node bb)
{
    double x = bb.x, y = bb.y, z = bb.z, a = aa.x, b = aa.y, c = aa.z;
    return sqrt((x - a) * (x - a) + (y - b) * (y - b) + (z - c) * (z - c));
}
void dfs(int u)
{
    if(e[u].z + r >= h)
    {
        flag = 1;
        return;
    }
    st[u] = 1;
    for (int i = 0; i < n; i ++)
    {
        if(!st[i] && dis(e[i], e[u]) <= r * 2)
            dfs(i); 
    }
}
signed main()
{
    int T;
    cin >> T;
    while(T --)
    {
        cin >> n >> h >> r;
        for (int i = 0; i < n; i ++)
        {
            double a, b, c;
            cin >> a >> b >> c;
            e[i] = {a, b, c};
        }
        sort(e, e + n);
        memset(st, 0, sizeof st);
        flag = 0;
        for (int i = 0; i < n; i ++)
        {
            if(!st[i] && e[i].z <= r)
                dfs(i);
        }
        if(flag)
            puts("Yes");
        else
           puts("No");
    }
}