HDU 1174 爆头 [计算几何]

Description

空间两个球，从一个球心射出一道射线，问能否与另外一个求相交

Algorithm

算另外那个球心到射线的距离，如果比R小，那么就相交
当然了，是射线不是直线，所以根本没射到那边的，当然打不到了。
这个怎么判断呢？
同向夹角θ>0，异向θ<0，算下点积就好了。

Code

#include <cstdio>
#include <cmath>
#include <iostream>
using namespace std;
const double eps = 1e-10;
double add(double a, double b)
{
  if (abs(a + b) < eps * (abs(a) + abs(b))) return 0;
  return a + b;
}
//向量或点
struct P
{
  double x, y, z;
  P(){}
  P(double x, double y, double z) : x(x), y(y), z(z){}
  P operator + (P p){return P(add(x, p.x), add(y, p.y), add(z, p.z));}
  P operator - (P p){return P(add(x, -p.x), add(y, -p.y), add(z, -p.z));}
};
double dot(P u, P v)
{
  return u.x * v.x + u.z * v.z + u.z * v.z;
}
//模长
double norm(P p)
{
  return sqrt(p.x * p.x + p.y * p.y + p.z * p.z);
}
//叉积
P cross(P u, P v)
{
  P ret;
  ret.x = u.y * v.z - v.y * u.z;
    ret.y = u.z * v.x - u.x * v.z;
    ret.z = u.x * v.y - u.y * v.x;
    return ret;
}
void solve()
{
  //1 土匪 2警察
  double h1, r1, x1, y1, z1;
  cin >> h1 >> r1 >> x1 >> y1 >> z1;
  double h2, r2, x2, y2, z2, x3, y3, z3;
  cin >> h2 >> r2 >> x2 >> y2 >> z2 >> x3 >> y3 >> z3;
  P t(x1, y1, z1 + h1 - r1); //匪球心点
  P ct(x2, y2, z2 + 0.9 * h2 - r2); //警球心点
  P u = t - ct;
  P v(x3, y3, z3);
  P uv = cross(u, v);
  double dist = norm(uv) / norm(v);
  //再判断是否同向
  if (dist <= r1 && (dot(u, v) > 0)) puts("YES");
  else puts("NO");
}
int main()
{
  int t;
  cin >> t;
  for (int i = 0; i < t; i++)
    solve();
}