算法训练 蜜蜂飞舞

Description

“两只小蜜蜂呀，飞在花丛中呀……”

话说这天天上飞舞着两只蜜蜂，它们在跳一种奇怪的舞蹈。用一个空间直角坐标系来描述这个世界，那么这两只蜜蜂初始坐标分别为(x1,y1,z1)，(x2,y2,z2)　　。在接下来它们将进行n次飞行，第i次飞行两只蜜蜂分别按照各自的速度向量飞行ti个单位时间。对于这一现象，玮玮已经观察了很久。他很想知道在蜜蜂飞舞结束时，两只蜜蜂的距离是多少。现在他就求教于你，请你写一个程序来帮他计算这个结果。

Input

输入描述:
　　第一行有且仅有一个整数n，表示两只蜜蜂将进行n次飞行。

接下来有n行。

第i行有7个用空格分隔开的整数ai,bi,ci,di,ei,fi,ti　　，表示第一只蜜蜂单位时间的速度向量为(ai,bi,ci) ，第二只蜜蜂单位时间的速度向量为(di,ei,fi) ，它们飞行的时间为ti 。

最后一行有6个用空格分隔开的整数x1,y1,z1,x2,y2,z2，如题所示表示两只蜜蜂的初始坐标。
输入样例:

Output

输出描述:
　　输出仅包含一行，表示最后两只蜜蜂之间的距离。保留4位小数位。
输出样例:

源码

#include <iostream>
#include <stdio.h>
#include <fstream>
#include <math.h>

using namespace std;

int fly[5000][7];

int main()
{
	//freopen("input/beefly.txt","r",stdin);
	int n;
	scanf("%d",&n);
	for(int i=0;i<n;i++)
	{
		for(int j=0;j<7;j++)
			scanf("%d",&fly[i][j]);
	}
	int x1,y1,z1,x2,y2,z2;
	scanf("%d%d%d%d%d%d",&x1,&y1,&z1,&x2,&y2,&z2);
	for(int i=0;i<n;i++)
	{
		x1+=fly[i][0]*fly[i][6];y1+=fly[i][1]*fly[i][6];z1+=fly[i][2]*fly[i][6];
		x2+=fly[i][3]*fly[i][6];y2+=fly[i][4]*fly[i][6];z2+=fly[i][5]*fly[i][6];
	}
	double sum1=(x1-x2)*(x1-x2),sum2=(y1-y2)*(y1-y2),sum3=(z1-z2)*(z1-z2);
	double sum=(double)sum1+sum2+sum3;
	double result=sqrt(sum);
	printf("%.4lf",result);
	return 0;	
}