7-6 拯救007 BFS

在老电影“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

题意：从中心湖能否到达岸上。
搜索的话，如果以中心湖为起点，由于他是个圆形，所以不太好处理，于是从岸边先里面搜索，能到达中心湖的判断条件，就是当前点距离中心湖的中心点的距离要小于d+15，这样就算是yes了

#include <bits/stdc++.h>
using namespace std;
const int N=1005;
int n,d,g[N][N],v[N][N];

int line(int a,int b,int c,int d)
{
	return ((c-a)*(c-a)+(d-b)*(d-b));
}

class node{
	public :
	int x,y;
	node(){
	}
	node(int a,int b){
		x=a;y=b;
	}
};
node ns[N];
bool bfs(){
	queue<node> q;
	for(int i=0;i<=100;++i){
		q.push(node(i,0));
		q.push(node(i,100));
		q.push(node(0,i));
		q.push(node(100,i));
	}
	while(!q.empty()){
		node t=q.front();q.pop();
		if(line(t.x,t.y,50,50)<=(d+15)*(d+15)){
			return true;
		}
		for(int i=0;i<n;i++){
			int x=ns[i].x,y=ns[i].y;
			if(v[x][y])continue;
			int len=line(t.x,t.y,x,y);
			if(len<=d*d){
				v[x][y]=1;
				q.push(node(x,y));
			}
		}
	}
	return false;
}
int main()
{
	cin>>n>>d;
	for(int i=0;i<n;++i)
	{
		int x,y;cin>>x>>y;
		x+=50;y+=50;
		ns[i]=node(x,y);
		g[x][y]=1;
	}
	if(bfs())cout<<"Yes"<<endl;
	else cout<<"No"<<endl;
	return 0;
}