拯救007（升级版）

7-35 拯救007（升级版）
在老电影“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
结尾无空行

#include <bits/stdc++.h>
const int INF =1e9;
using namespace std;
const int N=110;
int dist[N];//步数***这里n个鳄鱼，0~n-1表示鳄鱼，dist[n]表示最后一个鳄鱼到岸的那一步
//所以，n个鳄鱼要走到第n步
int path[N];//path[i]=u表示i点的前继节点为u
int n,d;//分别表示鳄鱼数，每步的距离
struct node
{
    int x,y;//鳄鱼位置的坐标,以中心岛为原点
    double firststep;//鳄鱼到（0，0）的距离
    bool operator<(const node&t)const
    {
        return firststep<t.firststep;
    }
}a[N];
void bfs()
{
    queue<int>q;//由于需要求最短路径，所以采用BFS使用队列
    double distance_end;
    for(int i=0;i<n;i++)
    {
        if(a[i].firststep>7.5&&a[i].firststep<=d+7.5)
        {//如果该鳄鱼不在中心岛内，并且人能一步踩到鳄鱼
            q.push(i);
            dist[i]=1;
            path[i]=-1;//由于该点是第一个点，所以前继点为-1
        }
    }
    while(q.size())
    {
        int t=q.front();
        q.pop();
        //以下顺时针分别枚举四种出边界情况：
        if(a[t].x>=0&&a[t].y>=0)
            distance_end=min(50-a[t].x,50-a[t].y);
        else if(a[t].x>=0&&a[t].y<=0)
            distance_end=min(50-a[t].x,a[t].y+50);
        else if(a[t].x<=0&&a[t].y>=0)
            distance_end=min(a[t].x+50,50-a[t].y);
        else if(a[t].x<=0&&a[t].y<=0)
            distance_end=min(a[t].x+50,a[t].y+50);
        if(distance_end<=d)//如果最后的距离能被一步走过
        {
            if(dist[n]==INF)//如果没有上过岸
            {
                dist[n]=dist[t]+1;
                path[n]=t;//点n的前继节点是t
                break;
            }
        }
        for(int i=0;i<n;i++)
        {
            if(dist[i]==INF)//如果该点没有被更新过，即没有被走过
            {
                double gap=sqrt((a[t].x-a[i].x)*(a[t].x-a[i].x)+(a[t].y-a[i].y)*(a[t].y-a[i].y));
                if(gap<=d)//鳄鱼距离之间能被一步踩过
                {
                    dist[i]=dist[t]+1;
                    q.push(i);
                    path[i]=t;//i点的前继节点为t
                }
            }
        }
    }
}
int main()
{
	fill(dist,dist+N,INF);
	fill(path,path+N,-1);
    stack<int>s;//需要用栈逆序输出具体路径
    cin>>n>>d;
    if(d>=42.5)//如果能够一步通关
    {
        cout<<1<<endl;
        return 0;
    }
    for(int i=0;i<n;i++)
    {
        cin>>a[i].x>>a[i].y;
        a[i].firststep=sqrt(a[i].x*a[i].x+a[i].y*a[i].y);
    }
    sort(a,a+n);
    bfs();
    if(dist[n]==INF)//没有成功上岸
    {
        cout<<0<<endl;
        return 0;
    }
    cout<<dist[n]<<endl;
    int u=path[n];
    int num=0;
    while(u!=-1)
    {
        s.push(u);
        num++;
        u=path[u];
    }
    for(int i=0;i<num;i++)
    {
        cout<<a[s.top()].x<<" "<<a[s.top()].y<<endl;
        s.pop();
    }
    return 0;
}

参考：https://blog.csdn.net/yiwaite/article/details/100584620?ops_request_misc=%257B%2522request%255Fid%2522%253A%2522163161833116780271519665%2522%252C%2522scm%2522%253A%252220140713.130102334…%2522%257D&request_id=163161833116780271519665&biz_id=0&utm_medium=distribute.pc_search_result.none-task-blog-2_allsobaiduend~default-1-100584620.first_rank_v2_pc_rank_v29&utm_term=%E6%8B%AF%E6%95%91007%E5%8D%87%E7%BA%A7%E7%89%88&spm=1018.2226.3001.4187