拯救007 (队列实现)

在老电影“007之生死关头”（Live and Let Die）中有一个情节，007被毒贩抓到一个鳄鱼池中心的小岛上，他用了一种极为大胆的方法逃脱 —— 直接踩着池子里一系列鳄鱼的大脑袋跳上岸去！（据说当年替身演员被最后一条鳄鱼咬住了脚，幸好穿的是特别加厚的靴子才逃过一劫。）

设鳄鱼池是长宽为100米的方形，中心坐标为 (0, 0)，且东北角坐标为 (50, 50)。池心岛是以 (0, 0) 为圆心、直径15米的圆。给定池中分布的鳄鱼的坐标、以及007一次能跳跃的最大距离，你需要告诉他是否有可能逃出生天。

输入格式：
首先第一行给出两个正整数：鳄鱼数量 N（≤100）和007一次能跳跃的最大距离 D。随后 N 行，每行给出一条鳄鱼的 (x,y) 坐标。注意：不会有两条鳄鱼待在同一个点上。

输出格式：
如果007有可能逃脱，就在一行中输出"Yes"，否则输出"No"。

输入样例 1：
14 20
25 -15
-25 28
8 49
29 15
-35 -2
5 28
27 -29
-8 -28
-20 -35
-25 -20
-13 29
-30 15
-35 40
12 12

输出样例 1：
Yes

输入样例 2：
4 13
-12 12
12 12
-12 -12
12 -12

输出样例 2：
No

#include<iostream>
#include<algorithm>
#include<cmath>
#include<queue>
using namespace std;
struct node{
	int x,y;
}p[105];
queue<node>v;
int n,d,flag,vis[105];
void dfs(){
	while(!v.empty()){
		node k=v.front();
		for(int i=0;i<n;i++){
			int x=p[i].x-k.x;
			int y=p[i].y-k.y;
			if(x*x+y*y<=d*d&&x*x+y*y!=0&&!vis[i]){
				v.push(p[i]);
			    vis[i]=1;
			}
		}
		int x1=50-k.x;
		int x2=k.x+50;
		int y1=50-k.y;
		int y2=k.y+50;
		if(x1<=d||x2<=d||y1<=d||y2<=d){
			printf("Yes\n");
			flag=1;
			return ;
		}
		v.pop();
	}
}
int main()
{
    scanf("%d %d",&n,&d);
    for(int i=0;i<n;i++){
    	scanf("%d %d",&p[i].x,&p[i].y);
	}
	for(int i=0;i<n;i++){
		double z=7.5+d;
		if(p[i].x*p[i].x+p[i].y*p[i].y<=z*z){
			v.push(p[i]);
			vis[i]=1; 
		}
	}
	dfs();
	if(!flag)
	printf("No\n");
    return 0;
}