7-5 拯救007（升级版） （30 分)（路径输出）

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

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

输入格式：

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

输出格式：

如果007有可能逃脱，首先在第一行输出007需要跳跃的最少步数，然后从第二行起，每行给出从池心岛到岸边每一步要跳到的鳄鱼的坐标 (x,y)。如果没可能逃脱，就在第一行输出 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

 题解：先找到一步可跳到岸边的点并用vector记录，然后Floyd暴力更新最短路，并更新每个节点的下一个节点是什么，用DFS输出路径

#include <bits/stdc++.h>
using namespace std;
const int INF=0x3f3f3f3f;
const int maxn=1010;
struct node
{
    int x,y;
}a[maxn];
int n,d,pos,dmin=INF;
int dis[maxn][maxn],nex[maxn][maxn];//dis记录最短路径，nex记录从i到j的最短路路径节点
vector<int> ans;
stack<int> S;
void DFS(int x,int y)
{
    if(nex[x][y]==-1)
    {
        if(x!=0)//原点不参与输出
          S.push(x);
    }
    else if(nex[x][y]!=INF)//由栈的特性从后往前放路径
    {
        DFS(nex[x][y],y);
        DFS(x,nex[x][y]);
    }
}
int main()
{
    cin>>n>>d;
    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))<=d)
        {
            ans.push_back(i);
        }
    }
    a[0].x=a[0].y=0;
    memset(dis,INF,sizeof(dis));
    memset(nex,INF,sizeof(nex));
    for(int i=0;i<=n;i++)
    {
        dis[i][i]=0;//注意
        for(int j=i+1;j<=n;j++)
        {
            double x=0;
            if(i==0) x=7.5;//池心岛半径
            double tx=a[i].x-a[j].x;
            double ty=a[i].y-a[j].y;
            double td=d+x;
            if(tx*tx+ty*ty<=td*td)//该步可走
            {
                dis[i][j]=dis[j][i]=1;//dis标记为1
                nex[i][j]=nex[j][i]=-1;//nex标记为-1
            }
        }
    }

    for(int k=0;k<=n;k++)
    {
        for(int i=0;i<=n;i++)
        {
            if(dis[i][k]==INF) continue;
            for(int j=0;j<=n;j++)
            {
                if(dis[k][j]==INF) continue;
                if(dis[i][j]>dis[i][k]+dis[k][j])
                {
                    dis[i][j]=dis[j][i]=dis[i][k]+dis[k][j];
                    nex[i][j]=nex[j][i]=k;//下一个节点,注意两边都要标记
                }
            }
        }
    }
    int num=INF;
    for(int i=0;i<ans.size();i++)//找最短路径（即最少要跳几步才能到达岸边）
        num=min(num,dis[0][ans[i]]+1);//num+1才是最终值，因为还要跳到岸边
    if(num==INF)//没有找到路径
    {
        cout<<"0"<<endl;
        return 0;
    }
    if(d>=50)//一步可跳到岸边
    {
        cout<<"1"<<endl;
        return 0;
    }
    for(int i=0;i<ans.size();i++)//找第一步最小的
    {
        if(num==dis[0][ans[i]]+1)
        {
            DFS(0,ans[i]);
            int k=S.top();
            double tx=a[k].x;
            double ty=a[k].y;
            if(dmin>tx*tx+ty*ty)//更新最优值
            {
                pos=ans[i];
                dmin=tx*tx+ty*ty;
            }
            while(!S.empty()) S.pop();//置零，以备下次DFS
        }
    }

    S.push(pos);
    DFS(0,pos);
    cout<<num<<endl;
    while(!S.empty())
    {
        int k=S.top(); S.pop();
        cout<<a[k].x<<" "<<a[k].y<<endl;
    }
    return 0;
}