PTA拯救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

题解：

这道题用BFS就可以解决了
主要有两点细节
1.题目说如果有多个最短路径则输出第一条最近的那条，因为我是用vec来存边的，所以直接写了一个比较函数用边权从小到大排
2.
中间还有一个圆心岛，所以初始位置可以是直径15的原里面的任意一点，开始一直没考虑一直报第四个点错
其他也没什么了，路径直接用path数组来存，每次都更新

#include
using namespace std;
const int N = 105;
double x[N],y[N],d,vis[N];
int n,path[N];
vector<pair<int,double> >vec[N];
double dist(int a,int b){ //距离函数
    return sqrt((x[a] - x[b]) * (x[a] - x[b]) + (y[a] - y[b]) * (y[a] - y[b]));
}
bool cmp(pair<int,double> a,pair<int,double> b){ //比较函数
    return a.second < b.second;
}
bool check(int a){
    if(50 - abs(x[a]) <= d || 50 - abs(y[a]) <= d) return 1;
    return 0;
}
void bfs(){
    vis[1] = 1;
    queue<int>q;
    q.push(1);
    while(!q.empty()){
        int k = q.front();q.pop();
        if(check(k)){
            int tmp[105],ans = 0;
            while(path[k] != 0){
                tmp[ans++] = k;
                k = path[k];
            }
            printf("%d\n",ans + 1);
            for(int i = ans - 1; i >= 0; i--) printf("%.0lf %.0lf\n",x[tmp[i]],y[tmp[i]]);
            return;
        }
        for(int i = 0; i < vec[k].size();i++){
            int p = vec[k][i].first;
            if(!vis[p]){
                vis[p] = 1,path[p] = k;
                q.push(p);
            }
        }
    }

    printf("0");
}
int main(){
    cin >> n >> d;
    ++n;
    x[1] = 0,y[1] = 0;
    for(int i = 2; i <= n; i++) cin >> x[i] >> y[i];
    for(int i = 1; i < n; i++)
        for(int j = i + 1; j <= n; j++){
            double p = dist(i,j);
            if(i == 1){ //初始点特判
                if(p <= d + 7.5){
                    vec[i].push_back(make_pair(j,p));
                    vec[j].push_back(make_pair(i,p));
                }
            }
            else{
                if(p <= d){
                    vec[i].push_back(make_pair(j,p));
                    vec[j].push_back(make_pair(i,p));
                }
            }
        }
    for(int i = 1; i <= n; i++)
        sort(vec[i].begin(),vec[i].end(),cmp);
    bfs();
}