奶酪 （bfs）

现有一块大奶酪，它的高度为h，它的长度和宽度我们可以认为是无限大的，奶酪中间有许多半径相同的球形空洞。

我们可以在这块奶酪中建立空间坐标系，在坐标系中，奶酪的下表面为z=0，奶酪的上表面为z=h。 

现在，奶酪的下表面有一只小老鼠Jerry，它知道奶酪中所有空洞的球心所在的坐标。

如果两个空洞相切或是相交，则Jerry可以从其中一个空洞跑到另一个空洞，特别地，如果一个空洞与下表面相切或是相交，Jerry则可以从奶酪下表面跑进空洞；如果一个空洞与上表面相切或是相交，Jerry则可以从空洞跑到奶酪上表面。

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

空间内两点P1(x1,y1,z1)、P2(x2,y2,z2)?1(?1,?1,?1)、?2(?2,?2,?2)的距离公式如下：

输入格式

每个输入文件包含多组数据。  

输入文件的第一行，包含一个正整数T，代表该输入文件中所含的数据组数。  

接下来是T组数据，每组数据的格式如下：

第一行包含三个正整数n，h和r，两个数之间以一个空格分开，分别代表奶酪中空洞的数量，奶酪的高度和空洞的半径。  

接下来的n行，每行包含三个整数x、y、z，两个数之间以一个空格分开，表示空洞球心坐标为(?,?,?)。

输出格式

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

数据范围

1≤n≤10001≤n≤1000,
1≤h,r≤1091≤h,r≤109,
T≤20T≤20,
坐标的绝对值不超过109109

输入样例：

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

题意理解
一句话题意:你要从最低点走到最高点,你必须从与下边界联通的洞孔开始走,而且每次只能走到和你所在奶酪相连通的奶酪.

对于两个奶酪而言,他们的距离必须小于2×r2×r,才被认为是相通的.

 

#include <bits/stdc++.h>
using namespace std;
const int N=1e4;
struct node{
    double x;
	double y;
	double z;
} a[N];
int vis[N],n,h,r,t;
queue<node> q,kong;

double dist(node a,node b){//计算两点之间的距离
    double fx=a.x-b.x;
	double fy=a.y-b.y;
	double fz=a.z-b.z;
    double ans=sqrt(fx*fx+fy*fy+fz*fz);
    return ans;
}

bool bfs(void){
    while(!q.empty()  ){
        if (q.front().z+r>=h)//如果满足条件.
            return true;
        node now=q.front();
        q.pop();
        for(int i=1; i<=n; i++){//所有的点都可以成为下一步的拓展.
            if (r*2>=dist(now,a[i]) && !vis[i]){//如果两点的距离<=2*r,而且这个点没有访问过.
                q.push(a[i]);//入队
                vis[i]=1;//已经访问过了
                if (q.front().z+r>=h)//如果满足条件,那么显然可以返回true
                    return true;
            }
        }
    }
    return false;//找不到合法路径
}
int main(){
    cin>>t;
    while(t--){
        cin>>n>>h>>r;
        for(int i=1; i<=n; i++)
            cin>>a[i].x>>a[i].y>>a[i].z;
        q=kong;//初始化
        memset(vis,false,sizeof(vis));//初始化不可少
        for(int i=1; i<=n; i++)
            if (a[i].z-r<=0)//如果和下边界接触
                q.push(a[i]),vis[i]=1;//才可以入队
        if (bfs())//判断是否找得到合法路径
            cout<<"Yes"<<endl;;
        else
            cout<<"No"<<endl;;
    }
    return 0;
}