T和Y的计划（C++）

题目描述

Time Limit: 1000 ms
Memory Limit: 256 mb

ACM星球的程序艺术学院的T和Y相恋了。Y快要毕业了，为了前途，Y也许要去别的星球发展他的事业。于是，T和Y开始计划以后如何见面。T有个好主意，她跟Y约定在距离ACM星球和Future星球连线的中点最短的Heart星球见面，你能帮他们找出来浪漫的Heart星球吗？

输入输出格式

输入描述:

首行为一个数N,表示有N个星球。 接下来N行，每行包括三个小数X,Y,Z，表示一个星球的坐标。 第N+2行包括三个小数X,Y,Z，表示ACM星球的坐标。 第N+3行包括三个小数X,Y,Z，表示Future星球的坐标。 N<=5000,1<=X,Y,Z<=99999

输出描述:

Heart星球的坐标。（保留3位小数）

输入样例：

5
1062.961900 47382.348900 49636.324000
21829.052500 75418.119200 6862.009300
24339.931000 6028.722000 27365.733500
20111.459200 22797.250400 42073.367900
29601.644400 39841.340000 55461.667800
21829.052500 75418.119200 6862.009300
20111.459200 22797.250400 42073.367900

 输出样例：

21829.053 75418.119 6862.009

#include<iostream>
#include<string.h>
#include<math.h>
#include<stdio.h>
using namespace std;
typedef struct{
	double x,y,z;
}locate;
int main(){
    //min_co存放最小距离点在数组中的下标  flag用来标记是否为第一次遍历
	int N,flag = 1,min_co = 0;
	double min = 0;//存放最小距离
	locate a[5005];
	memset(a,0,sizeof(a));
	cin>>N;
	for(int i = 0; i < N; i++){
		cin>>a[i].x>>a[i].y>>a[i].z;
	}
	locate ACM,Future,Heart;
	cin>>ACM.x>>ACM.y>>ACM.z;
	cin>>Future.x>>Future.y>>Future.z;
	Heart.x = (ACM.x + Future.x)/2;
	Heart.y = (ACM.y + Future.y)/2;
	Heart.z = (ACM.z + Future.z)/2;//计算中点
	for(int i = 0; i < N; i++){
		double x = Heart.x - a[i].x;
		double y = Heart.y - a[i].y;
		double z = Heart.z - a[i].z;
		double temp = sqrt(pow(x,2)+pow(y,2)+pow(z,2));//计算距离
		if(flag){
			min = temp;
			min_co = i;
			flag = 0;
		}
		else{
			if(min > temp){
				min = temp;
				min_co = i;
			}
		}
	}
	printf("%.3lf %.3lf %.3lf",a[min_co].x,a[min_co].y,a[min_co].z);
	return 0;
}