pat--拯救007（升级版）

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

设鳄鱼池是长宽为100米的方形，中心坐标为 (0, 0)，且东北角坐标为 (50, 50)。池心岛是以 (0, 0) 为圆心、直径15米的圆。给定池中分布的鳄鱼的坐标、以及007一次能跳跃的最大距离，你需要给他指一条最短的逃生路径 —— 所谓“最短”是指007要跳跃的步数最少。

输入格式：

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

输出格式：

如果007有可能逃脱，首先在第一行输出007需要跳跃的最少步数，然后从第二行起，每行给出从池心岛到岸边每一步要跳到的鳄鱼的坐标 (。如果没可能逃脱，就在第一行输出 0 作为跳跃步数。如果最短路径不唯一，则输出第一跳最近的那个解，题目保证这样的解是唯一的。

输入样例 1：

17 15
10 -21
10 21
-40 10
30 -50
20 40
35 10
0 -10
-25 22
40 -40
-30 30
-10 22
0 11
25 21
25 10
10 10
10 35
-30 10

输出样例 1：

4
0 11
10 21
10 35

输入样例 2：

4 13
-12 12
12 12
-12 -12
12 -12

输出样例 2：

0

主要思路就是找出任意两点的最优步数，然后再遍历 0 --> 能一步跳出湖的点  的最少步数,再根据第一步距离得最优解；

#include<bits/stdc++.h>
using namespace std;
struct node{
	int x,y;
}a[105];
int d[105][105],dp[105][105],f[105][105];
const int inf=0xffffff;
stack<int>p;
void dfs(int x,int y)//寻路径 
{
	if(f[x][y]==-1)//说明两点直接没有间接点了 
	{
		if(x!=0)
	    p.push(x);
	}
	else if(f[x][y]!=-2) //-2说明两点不可达 
	{
		dfs(f[x][y],y);
		dfs(x,f[x][y]);
	}
}
int main()
{
	int n;
	double m;
	cin>>n>>m;
	if(m>=50)
	{
		cout<<'1'<<endl;
		return 0;
	}
	a[0].x=a[0].y=0;
	vector<int> q;
	/*找出所有可以一次跳出的点*/
	for(int i=1;i<=n;i++)
	{
		cin>>a[i].x>>a[i].y;
		if(min(50-abs(a[i].x),50-abs(a[i].y))<=m)
		{
			q.push_back(i);
		}
	}
	for(int i=0;i<=n;i++)
	{	
		for(int j=0;j<=n;j++)
		{
			f[i][j]=-2;
			d[i][j]=i==j?0:inf;
		}
	}
	/*d[i][j]标记任意两点直接是否满足他所能跳的最大距离*/ 
	for(int i=0;i<=n;i++)
	{
		for(int j=i+1;j<=n;j++)
		{
			double x=0;
			if(i==0) x=7.5;
			if((a[i].x-a[j].x)*(a[i].x-a[j].x)+(a[i].y-a[j].y)*(a[i].y-a[j].y)<=(m+x)*(m+x))
			{
				d[i][j]=d[j][i]=1;
				f[i][j]=f[j][i]=-1;
			}	
		}
	}
	/*弗洛伊德暴力任意两点之间的最少步数*/
	for(int k=0;k<=n;k++)
	{
		for(int i=0;i<=n;i++)
	     {
	     	if(d[i][k]==inf) continue;
	     	for(int j=0;j<=n;j++)
	     	{
	     		if(d[k][j]==inf) continue;
	     		if(d[i][j]>d[i][k]+d[k][j])
	     		{
	     			d[i][j]=d[i][k]+d[k][j];
	     			f[i][j]=f[j][i]=k;
				 }
			 }
		 }
	}
	int mi=inf,g,t=inf;
	for(int i=0;i<q.size();i++) 
	{
		if(mi>d[0][q[i]]+1)
	    	{
	    		mi=d[0][q[i]]+1;//找出最小步数 mi 
	    		g=q[i];
			}
	 } 
	 for(int i=0;i<q.size();i++)
	{
		if(mi==d[0][q[i]]+1)//再找出在mi相同情况下，第一步最小的解 
	    	{
	    		dfs(0,q[i]);
	    		int k=p.top();
	    		if(a[k].x*a[k].x+a[k].y*a[k].y<t)
	    		{
	    			g=q[i];
	    			t=a[k].x*a[k].x+a[k].y*a[k].y;
				}
				 while(!p.empty())
				 {
				 	p.pop();
				 }
			}
	 } 
	 if(mi==inf) { 
	 	cout<<'0';
	 	return 0;
	 }
	 cout<<mi<<endl;
	 p.push(g);
	 dfs(0,g);
	 while(!p.empty())
	 {
	 	int k=p.top();
	 	p.pop();
	 	 cout<<a[k].x<<' '<<a[k].y<<endl;
	 }
 }