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：

输出样例 1：

输入样例 2：

输出样例 2：

拿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;
}