07-图5 Saving James Bond - Hard Version (30分)

#07-图5 Saving James Bond - Hard Version (30分)
1.选择性录入鳄鱼坐标，因为不是所有都在湖中
2.题意表明，可能有起点鳄鱼不同，但跳的步数相同的取起点鳄鱼较近的那一条，所以要先按照起点鳄鱼远近排序，避免后面麻烦的比较。
3.dfs的时候记录下终点鳄鱼方便输出

#include<stdio.h>
#include<math.h>
typedef struct {
	int x,y;
} box;
typedef struct {
	int pre;
	int total;
} box2;
typedef struct {
	int data[105];
	int head,rear;
} quene;
box data[105];//存储鳄鱼的坐标
box2 path[105];//里面含有上一个节点的坐标，以及到这一步最少的步数
int visit[105];
int n,d;
int first;//第一步能跳的鳄鱼个数
quene q;
void init(quene &q) {
	q.head=q.rear=-1;
}
bool isempty(quene q) {
	return q.head==q.rear;
}
void enquene(quene &q,int i) {
	q.data[++q.rear]=i;
}
int outquene(quene& q) {
	return q.data[++q.head];
}
bool issafe(box a) {
	if(50-abs(a.x)<=d||50-abs(a.y)<=d) return true;
	return false;
}
void swapbox(box &a,box &b) {
	box temp=a;
	a=b;
	b=temp;
}
bool cmp(box a,box b) {
	return pow(a.x,2)+pow(a.y,2)>pow(b.x,2)+pow(b.y,2);
}
bool canjump(box a,box b) {
	return d*d>=pow(a.x-b.x,2)+pow(a.y-b.y,2);
}
void prepare() {
	init(q);
	for(int i=0; i<n; i++) {
		path[i].pre=-1;
		path[i].total=10000;
	}
}
int bfs(int f) {//
	visit[f]=1;
	enquene(q,f);
	path[f].total=1;
	if(issafe(data[f])) {
		return f;
	}
	while(!isempty(q)) {
		int v=outquene(q);
		for(int i=first; i<n; i++) {
			if(canjump(data[v],data[i])&&path[i].total>path[v].total+1) {
				visit[i]=1;
				enquene(q,i);
				path[i].pre=v;
				path[i].total=path[v].total+1;
				if(issafe(data[i])) return i;
			}
		}
	}
	return -1;
}
void print(int tempv) {
	if(tempv==-1) return;
	print(path[tempv].pre);
	printf("%d %d\n",data[tempv].x,data[tempv].y);
}
void getpath() {
	if(first==0) {
		printf("0\n");
		return;
	}
	prepare();
	for(int i=0; i<first; i++) visit[i]=bfs(i);
	int count=100,tempv=1000;
	for(int i=0; i<first; i++) {
		if(visit[i]!=-1) {
			if(path[visit[i]].total<count) {
				count=path[visit[i]].total;
				tempv=visit[i];
			}
		}
	}
	if(tempv==1000) printf("0\n");
	else {
		printf("%d\n",path[tempv].total+1);
		print(tempv);
	}
}
void getxy() {
	int actn=0;
	for(int i=0; i<n; i++) {
		int x,y;
		scanf("%d%d",&x,&y);
		if(x*x+y*y>7.5*7.5&&50>abs(x)&&50>abs(y)) {
			data[actn].x=x;
			data[actn++].y=y;
		}
	}
	n=actn;//录入并删掉无用节点
	for(int i=0; i<n; i++) {
		for(int j=i+1; j<n; j++) 	if(cmp(data[i],data[j])) swapbox(data[i],data[j]);
		if(pow(data[i].x,2)+pow(data[i].y,2)>(7.5+d)*(7.5+d)) {
			first=i;
			break;
		}
	}//将能跳的鳄鱼由近到远排序
}
int main() {
	scanf("%d%d",&n,&d);
	getxy();
	if(d>50-7.5) printf("1\n");
	else getpath();
	return 0;
}