HDU 1174 爆头 [计算几何]

最新推荐文章于 2019-09-27 19:58:12 发布

原创最新推荐文章于 2019-09-27 19:58:12 发布 · 544 阅读

0 ·

本内容遵循CC 4.0 BY-SA版权协议

本文介绍了一种判断空间中一条从一个球心发出的射线是否与另一个球体相交的方法。通过计算球心到射线的距离，并结合射线的方向判断，实现了准确快速的相交检测。

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