Tmk射气球

Description

有一天TMK在做一个飞艇环游世界，突然他发现有一个气球匀速沿直线飘过，tmk想起了他飞艇上有一把弓，他打算拿弓去射气球，为了提高射击的准确性，他首先在飞艇上找到一个离气球最近的一个点，然后射击（即使气球在飞船的正上方），现在求某些时刻飞艇上的点和气球的距离最小是多少（这个最小距离我们简称为飞艇到气球的距离）。
Input

第一行一个整数T(T<=20)，表示有T组测试数据
每组测试数据，有两行。
第一行有5个整数，h,x1,y1,x2,y2，其中h表示飞船的高度，飞船可抽象为一个线段，(x1,y1)(x2,y2)分别是这个线段的端点（有可能会有(x1,y1)(x2,y2)重合的情况）
第二行有6个整数，x,y,z,X,Y,Z分别表示气球的在第0秒的时候的横坐标，纵坐标，高度，一秒时间气球横坐标的变化量，一秒时间气球纵坐标的变化量，一秒时间气球高度的变化量(如果现在气球在(x0,y0,z0)下一秒坐标就为(x0+X,y0+Y,z0+Z))
第三行1个整数n，表示询问组数
接下来的n行，每行一个整数，表示询问的秒数t
题目涉及的整数除了T以外，范围均为[0,1000]

Output

每组询问输出n行，每行输出一个数，表示在t秒的时候飞艇与气球的距离最小是多少，保留两位小数

Sample Input

1
1 1 1 2 2
0 0 0 4 4 4
2
0
3
Sample Output

1.73
17.92

The solution

#include <bits/stdc++.h>
using namespace std;
#define rep1(i,x,y) for (int i = x;i <= y;i++)
#define LL long long

LL h,xx1,yy1,xx2,yy2,xx,yy,zz,XX,YY,ZZ;

LL sqr(LL x) {return x*x;}

double dis(LL x1 , LL y1 , LL z1 , LL x2 , LL y2 , LL z2)
{
    return sqrt(sqr(x1-x2)+sqr(y1-y2)+sqr(z1-z2));
}
   //d=√[(x1-x2)^2+(y1-y2)^2+(z1-z2)^2] ——>三维空间座标两点间距离公式

bool in(LL x1 , LL y1 , LL x2 , LL y2 , LL x3 , LL y3)
{
    return (x3-x1)*(x2-x1)+(y3-y1)*(y2-y1)>0 && (x1-x2)*(x3-x2)+(y1-y2)*(y3-y2)>0;
}

int main()
{
    int T;
    int i;
    scanf("%d",&T);   

    while (T--)      
    {
        cin >> h >> xx1 >> yy1 >> xx2 >> yy2;    //每一秒的飞船坐标 
        cin >> xx >> yy >> zz >> XX >> YY >> ZZ;   //气球的变化 
        int n;
        cin >> n;
        for (i=1;i<=n;i=i+1)
        {
            LL t;
            cin >> t; //第几秒 
            LL xx3,yy3,zz3; 
            xx3 = xx+XX*t;  //横坐标 
            yy3 = yy+YY*t;  //纵坐标
            zz3 = zz+ZZ*t;  //高度 
            if (xx1==xx2 && yy1==yy2)  //当(x1,y1)(x2,y2)重合时 
            {
                cout << fixed << setprecision(2) << dis(xx1,yy1,h,xx3,yy3,zz3)<<endl;
                continue;
            }
            //setprecision(n) 控制输出流显示浮点数的数字个数
            double a = dis(xx1,yy1,h,xx3,yy3,zz3);
            double b = dis(xx2,yy2,h,xx3,yy3,zz3);
            double c = dis(xx1,yy1,h,xx2,yy2,h);
            if (in(xx1,yy1,xx2,yy2,xx3,yy3))
            {
                double dd = (a*a+c*c-b*b)/(2.0*c);
                double ans= sqrt(a*a-dd*dd);
                cout << fixed << setprecision(2) << ans <<endl;
            }
            else
            {
                cout << fixed << setprecision(2) << min(a,b) <<endl;
            }
        }
    }
    return 0;
}