爆头

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
 

Author
lwg
链接：http://acm.hdu.edu.cn/showproblem.php?pid=1174

问题转化：空间点到直线的距离---即土匪的头心到子弹所在直线的距离是否小于头半径
点积: cos
叉积：sin

B到直线AC的距离就是|AB叉乘AC|/|AC|
A警察头心   B匪徒头心   AC 与r同向

#include<stdio.h>
#include<math.h>
int main()
{
	
    int n;
	scanf("%d",&n);
	while(n--)
	{
	    double h1,r1,x1,y1,z1;   //分别表示土匪的身高，头部半径以及所站的位置
	    double h2,r2,x2,y2,z2,x3,y3,z3;//分别表示警察的身高，头部半径，所站位置，以及枪头所指方向的方向向量。
		scanf("%lf%lf%lf%lf%lf",&h1,&r1,&x1,&y1,&z1);
		scanf("%lf%lf%lf%lf%lf%lf%lf%lf",&h2,&r2,&x2,&y2,&z2,&x3,&y3,&z3);
		double k1=z1+h1-r1;//匪徒头部中点；
		double k2=z2+0.9*h2-r2;//警察头部中点；
		double a=x1-x2,b=y1-y2,c=k1-k2;//匪徒与警察头部连线的向量。
		double a1=b*z3-y3*c;//枪的向量与匪徒与警察的头部向量的叉积。   
        double b1=a*z3-x3*c;  
        double c1=a*y3-b*x3; 
		double dis = sqrt((a1*a1+b1*b1+c1*c1)/(x3*x3+y3*y3+z3*z3));//枪的距离与匪徒的距离
		if(dis<=r1&&(a*x3+b*y3+c*z3>0))//A->B与r矢量之间的夹角是锐角
			printf("YES\n");
		else
			printf("NO\n");

	}
	return 0;
}