L2-1 拯救007（升级版）

L2-1 拯救007（升级版） （25 分)

在老电影“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做的，有一个样例没过去，还有6分没得到，希望以后能改过来

#include <bits/stdc++.h>
#define INF 0x3f3f3f3f
using namespace std;
typedef pair<int,int> P;
typedef long long ll;
const int maxn = 100 + 10;
int n,dax,dax2,p[maxn],vis[maxn];
struct node
{
    int no,x,y,step;
    node() {}
    node(int id,int a,int b,int e):no(id),x(a),y(b),step(e) {}
    bool operator <(const node & r)const
    {
        int dx = abs(x - r.x);
        int dy = abs(y - r.y);
        return dx < dy;
    }
} mp[maxn];
//map<int,node> mp;
int bfs()
{
    memset(p,-1,sizeof(-1));
    memset(vis,0,sizeof(vis));
    vis[0] = 1;
    queue<node> q;
    q.push(node(0,0,0,1));
    while(!q.empty())
    {
        node now = q.front();
        q.pop();
//        printf("u:%d %d %d\n",now.no,now.x,now.y);
        if(now.x + dax >= 50 || now.y + dax >= 50)
        {
            printf("%d\n",now.step);
            return now.no;
        }
        for(int i = 1; i <= n; i++)
        {
            if(vis[i]) continue;
            int dx = abs(mp[i].x - now.x);
            int dy = abs(mp[i].y - now.y);
            if(now.x == 0 && now.y == 0)
            {
                if(dx * dx + dy * dy <= (dax + 7.5) * (7.5 + dax))
                {
                    vis[i] = 1;
                    p[i] = now.no;
                    q.push(node(i,mp[i].x,mp[i].y,now.step + 1));
                }
            }
            else if(dx * dx + dy * dy <= dax2)
            {
//                printf("v:%d %d %d\n",i,mp[i].x,mp[i].y);
                vis[i] = 1;
                p[i] = now.no;
                q.push(node(i,mp[i].x,mp[i].y,now.step + 1));
            }
        }
    }
    return -1;
}
int main()
{
    int u,v;
    scanf("%d%d",&n,&dax);
    dax2 = dax * dax;
    for(int i = 1; i <= n; i++)
    {
        scanf("%d%d",&u,&v);
        mp[i] = node(i,u,v,0);
    }
    sort(mp + 1,mp + n + 1);
    for(int i = 1;i <= n;i++) mp[i].no = i;
    int ans = bfs();
    if(ans == -1) printf("0\n");
    else
    {
        stack<int> s;
        for(int i = ans; i != -1; i = p[i])
        {
            s.push(i);
        }
        s.pop();
        while(s.size())
        {
            int id = s.top(); s.pop();
            printf("%d %d\n",mp[id].x,mp[id].y);
        }
    }
    return 0;
}