G - 爆头(30) （几何）

gameboy是一个CS高手，他最喜欢的就是扮演警察，手持M4爆土匪的头。也许这里有人没玩过CS，有必要介绍一下“爆头”这个术语：所谓爆头，就是子弹直接命中对方的头部，以秒杀敌人。

现在用一个三维的直角坐标系来描述游戏中的三维空间（水平面为xoy平面，z轴正方向是上方）。假设游戏中角色的头是一个标准的球。告诉你土匪的身高，头部半径，所站位置的坐标；gameboy所控警察的身高，头部半径，所站位置的坐标，以及枪头所指方向的单位向量。gameboy所控警察所握的是M4，抢瞄准时枪膛中的子弹跟视线基本同线，我们忽略它们的距离，就当成同线。由于土匪手持AK47,所以他是很嚣张地正立着。而警察手持M4，正在瞄准，由于瞄准时身体微弯，视线从头心出发，他头部的实际高度比正立时低10%。

你的任务就是，计算gameboy在这一刻扣下扳机，能否爆土匪的头。注意：这里忽略子弹的直径和重力作用，也就是说子弹是无限小的，弹道是一条笔直的射线，警察与土匪间没有障碍物。并且只要子弹擦到头部，哪怕是边缘，也算爆头。

Input

测试数据的第一行有一个正整数T，表示有T组测试数据。每组数据的第一行有五个实数，h1,r1,x1,y1,z1，分别表示土匪的身高，头部半径以及所站的位置。第二行有八个实数，h2,r2,x2,y2,z2,x3,y3,z3，分别表示警察的身高，头部半径，所站位置，以及枪头所指方向的方向向量。

Output

每一组输入数据对应一行输出。如果能爆土匪的头，输出"YES",否则输出"NO"。

Sample Input

2
1.62 0.1 10.0 10.0 10.0
1.80 0.09 0.0 0.0 0.0 1.0 1.0 1.0
1.62 0.1 0.0 0.0 0.0
1.80 0.09 10.0 10.0 10.0 -1.0 -1.0 -1.0

Sample Output

YES
YES

题解：我们求出土匪球心到方向向量的距离，看其是否小于等于土匪的半径，并且保证警察是瞄准的土匪那一侧，而不是反向！

那么求空间一点到直线的距离，我们可以运用叉乘运算：两个向量AB,AC做叉乘运算取模后得到的是以AB,AC为邻边的平行四边形的面积，我们再除以AC的模长，得到的即是点B到直线AC的距离～～，保证方向正确的话，我们可以用做点积，看其是否大于0即可（大于0说明角度小于90度）

#include<iostream>
#include<cmath>
#include<algorithm>
using namespace std;//求土匪球心到方向向量(x3,y3,z3)的距离，可用叉乘运算
double dist(double x1,double y1,double z1,double x2,double y2,double z2)
{
    double x=y1*z2-y2*z1;
    double y=x1*z2-x2*z1;
    double z=x1*y2-x2*y1;
    double son=sqrt(x*x+y*y+z*z);
    double mother=sqrt(x2*x2+y2*y2+z2*z2);
    return son/mother;
}
int main()
{
    int t;
    cin>>t;
    while(t--)
    {
        double h1,r1,x1,y1,z1;
        double h2,r2,x2,y2,z2,x3,y3,z3;
        cin>>h1>>r1>>x1>>y1>>z1;
        cin>>h2>>r2>>x2>>y2>>z2>>x3>>y3>>z3;
        z1+=h1-r1;      //按照题意先进行预处理
        z2+=h2*0.9-r2;
        x1=x1-x2; //构造向量
        y1=y1-y2;
        z1=z1-z2;
        double dis=dist(x1,y1,z1,x3,y3,z3);//求出土匪球心到直线（即方向向量x3,y3,z3所成的直线)的距离
        if(dis<=r1&&(x1*x3+y1*y3+z1*z3)>0)//如果土匪球心到直线的距离小于半径并且警察瞄准的是土匪那侧！
            cout<<"YES"<<endl;
        else
            cout<<"NO"<<endl;
    }
    return 0;
}