HDU 1174 爆头 [计算几何]

来源：互联网发布：源码天下yuanmatx 编辑：程序博客网时间：2024/05/07 12:15

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();}

0 0