射线与球的相交性检测

转载 2016年07月13日 13:37:33

从图形来说

射线和圆相交, origin是射线起点, dir是射线的方向向量。p0,p1是两个交点,center为圆心,半径为R,d为圆心到射线的距离。

我们先以2D切面图来说明,当射线和圆相交的时候,可以看到,球心 center 到射线 ray 的距离 d <= R,这个即为相交的条件。那么射线与球相切就转化为了球心到射线的距离d的判断。先求出d:

  1. 设圆心在射线上的投影为c',则 origin,center, c' 形成了一个直角三角形。
  2. 获得射线起点到圆心的向量 Voc = Vcenter - Vorigin
  3. 在射线方向上的投影为: Poc = Voc·dir
  4. 勾股定理:d·d = Voc·Voc - Poc·Poc

可以求出d的数值,

  • d < R,射线穿过圆,与圆有两个交点。
  • d = R,射线与圆相切,有一个交点为切点。
  • d > R,射线在圆外,没有交点。

接下来求P0,P1:

  1. c',center,P0 or P1点构成直角三角形。
  2. P0 or P1到c'的距离 tca·tca = R·R - d·d;
  3. 有如下式子
  4. P0 = dir·( |Poc| - tca );
    P1 = dir·( |Poc| + tca );
要注意,没有交点的时候, tca·tca < 0 是没办法开平方的

推导三维情况可以照上面的去做,dot能保证投影点在同一个平面上的。

附代码

bool Intersect(const Ray& ray, const Sphere& sphere, float& t0, float& t1)
{
    Vector3 oc = sphere.GetCenter() - ray.GetOrigin();
    float projoc = dot(ray.GetDirection(), oc);

    if (projoc < 0)
        return false;

    float oc2 = dot(oc, oc);
    float distance2 = oc2 - projoc * projoc;   //计算出的球心到射线的距离

    if (distance2 > sphere.GetRadiusSquare())
        return false;

    float discriminant = sphere.GetRadiusSquare() - distance2;  //使用勾股定理,计算出另一条边的长度
    if(discriminant < FLOAT_EPSILON)   //表明只有一个交点,射线与球相切
        t0 = t1 = projoc;
    else
    {
        discriminant = sqrt(discriminant);
        t0 = projoc - discriminant;
        t1 = projoc + discriminant;
        if (t0 < 0)
            t0 = t1;
    }
    return true;
}

从方程角度来看

射线方程:ray : P(t) = O + D·t ( t >= 0 )
球的方程:sphere : sqr( P-C ) = R·R (sqr(x) = x^2 = x·x)

O=origin, D=direction, C=center, R=radius

射线方程表明的是如下一个点的集合P,当t从零增大时, D·t会沿着D向量的方向从零逐步变长,t 取值无限表示了射线单方向。从O点开始在D方向上无限个点构成了一条射线。
球的方程表明了任何点P,只要到C点的距离等于半径R,则表明点在球面上,这么一个球面上的点的集合。
因此当射线与球相交的时候,这个点既在射线上,又在球面上。等式射线的P(t) = 球的P成立。

联立两个方程,试着求解 t 有:

sqr( O + D·t - C ) = R·R

设 O-C=OC,有:

sqr( OC+D·t ) - R·R = 0
//展开得到如下式子
=> D·D·t·t + 2·OC·D·t + OC·OC - R·R = 0
=> (D·Dt·t + 2·(OC·Dt + OC·OC - R·R = 0

因为 D 是单位向量有D·D = dot(D, D) = 1最后方程为:

t·t + 2·(OC·D)·t +  OC·OC - R·R = 0;

这是一个关于 t 的二次方程at^2 + bt + c = 0那么解就已经出来了:

  • t0 = -(b + √Δ) / 2a
  • t1 = -(b - √Δ) / 2a
    • a = D·D = dot(D, D) = 1;
    • b = 2·OC·D = 2·dot(OC, D);
    • c = OC·OC - R·R = dot(OC, OC) - R·R;
    • 判别式 Δ = sqr(b) - 4ac
      = 4·sqr( OC·D ) - 4·( OC·OC - R·R )
      = 4·( sqr( OC·D ) - OC·OC + R·R );
      如果判别式 Δ > 0,则表明球与射线相交。

根据以上方程,我们其中试着展开 t 的式子
t0 = -(b + √Δ) / 2a = -(b + √Δ) / 2·1
= -b/2 - √(Δ/4)
= -dot(OC, D) - √( sqr( dot(OC, D) ) - dot(OC, OC) + R·R )

求出 t 后可以根据P(t) = O + D * t 得到交点。

附chai3d中的计算代码

inline int cIntersectionSegmentSphere(const cVector3d& a_segmentPointA,
                                      const cVector3d& a_segmentPointB,
                                      const cVector3d& a_spherePos,
                                      const double& a_sphereRadius,
                                      cVector3d& a_collisionPoint0,
                                      cVector3d& a_collisionNormal0,
                                      cVector3d& a_collisionPoint1,
                                      cVector3d& a_collisionNormal1)
{
    // temp variables
    cVector3d AB, CA;
    a_segmentPointB.subr(a_segmentPointA, AB);
    a_segmentPointA.subr(a_spherePos, CA);
    double radiusSq = a_sphereRadius * a_sphereRadius;

    double a = AB.lengthsq();
    double b = 2.0 * cDot(AB, CA);
    double c = CA.lengthsq() - radiusSq;

    // invalid segment
    if (a == 0)
    {
        return (0);
    }

    double d = b*b - 4*a*c;

    // segment ray is located outside of sphere
    if (d < 0)
    {
        return (0);
    }

    // segment ray intersects sphere
    d = sqrt(d);
    double e = 2.0 * a;

    // compute both solutions
    double u0 = (-b + d) / e;
    double u1 = (-b - d) / e;

    // check if the solutions are located along the segment AB
    bool valid_u0 = cContains(u0, 0.0, 1.0);
    bool valid_u1 = cContains(u1, 0.0, 1.0);

    // two intersection points are located along segment AB
    if (valid_u0 && valid_u1)
    {
        if (u0 > u1) { cSwap(u0, u1); }

        // compute point 0
        AB.mulr(u0, a_collisionPoint0);
        a_collisionPoint0.add(a_segmentPointA);

        a_collisionPoint0.subr(a_spherePos, a_collisionNormal0);
        a_collisionNormal0.normalize();

        // compute point 1
        AB.mulr(u1, a_collisionPoint1);
        a_collisionPoint1.add(a_segmentPointA);

        a_collisionPoint1.subr(a_spherePos, a_collisionNormal1);
        a_collisionNormal1.normalize();

        return (2);
    }

    // one intersection point is located along segment AB
    else if (valid_u0)
    {
        // compute point 0
        AB.mulr(u0, a_collisionPoint0);
        a_collisionPoint0.add(a_segmentPointA);

        a_collisionPoint0.subr(a_spherePos, a_collisionNormal0);
        a_collisionNormal0.normalize();

        // check dot product to see if the intial segment point is located
        // inside the sphere.
        double dotProduct = cDot(AB, a_collisionNormal0);   //如果射线在球内部与球发生相交,就不能算作相交,保证射线运动的方向性,射线从球体出来时的交点不算作相交点
        if (dotProduct < 0.0)
        {
            return (1);
        }
        else
        {
            return (0);
        }
    }

    // one intersection point is located along segment AB
    else if (valid_u1)
    {
        // compute point 0
        AB.mulr(u1, a_collisionPoint0);
        a_collisionPoint0.add(a_segmentPointA);

        a_collisionPoint0.subr(a_spherePos, a_collisionNormal0);
        a_collisionNormal0.normalize();

        // check dot product to see if the intial segment point is located
        // inside the sphere.
        double dotProduct = cDot(AB, a_collisionNormal0);
        if (dotProduct < 0.0)
        {
            return (1);
        }
        else
        {
            return (0);
        }
    }

    // both points are located outside of the segment AB
    else
    {
        return (0);
    }
}</span>

文/goteet(简书作者)
原文链接:http://www.jianshu.com/p/1b008ed86627
著作权归作者所有,转载请联系作者获得授权,并标注“简书作者”。

第9周:卷积神经网络分类任务和检测任务

本课程共分为三个阶段。从机器学习到深度学习,再到项目实战,循序渐进,层层深入。除了系统讲解成为一名人工智能工程师所需的理论知识外,每节课还会配有实战案例,通过练习巩固所学知识,学以致用解决实际问题。第三个阶段包含四个大型工业级综合实战案例,采用大量真实数据集,完美模拟工作场景。学完后,大家绝对可以胜任人工智能领域相关工作。
  • 2018年04月08日 14:20

射线与球体相交检测

原理:参照实时碰撞检测算法技术上的原理: 但书上的实现是错的。 C++实现: static bool getRaySphereIntersect(vector3d rayOrigin, v...
  • shenlan282
  • shenlan282
  • 2016-11-17 20:19:14
  • 652

碰撞检测之Ray-Cylinder检测

正交基和标准正交基首先来看定义Let S = {v1, v2, ... , vk} be a set of vectors in Rn, then S is called an orthogonal ...
  • qp120291570
  • qp120291570
  • 2016-02-26 02:13:18
  • 2487

相交---光线与球

光线与球之间的相交很容易计算。如果光线的两端分别是(x1,y1,z1)和(x2,y2,z2),则第一步是将光线参数化:                x=x1+(x2-x1)t=x1+it    ...
  • u012181898
  • u012181898
  • 2016-11-26 17:37:47
  • 262

线段和圆/球的相交性检测

本文讨论2D中线段和圆的相交性检测,检测的方法也适用于3D中线段和球之间的相交性测试,这是因为可以在包含线段和球心的平面进行检测,从而将3D问题转化为2D问题。(如果线段包含在穿过球心的直线上,那么这...
  • miao0967020148
  • miao0967020148
  • 2015-12-23 22:51:59
  • 1047

[Unity]已知圆点和射线 求射线与圆相交的一点

参考资料1: magnitude  Returen the length of vector(Read Only). 然后就试了一下这个方法。 Vector3 P1 = new Vector3...
  • BuladeMian
  • BuladeMian
  • 2017-06-18 10:49:48
  • 974

计算射线与平面的交点(三维空间)

说在开头 这里简单的介绍一下计算射线与平面交点的方法。主要使用的是射线的参数方程和平面的参数方程。当然还需要一些向量的数学知识。本人的知识有限,如果本节内容有错误和不合理之处,还请朋友们多多指出,我...
  • ModestBean
  • ModestBean
  • 2018-02-04 10:05:31
  • 131

3D空间中射线与三角形的交叉检测算法

详解Ray-Triangle交叉检测算法,并且提供代码示例,供您参考
  • i_dovelemon
  • i_dovelemon
  • 2014-08-01 11:13:07
  • 6374

判断线段是否与圆相交模板

判断线段和圆是否相交 判断圆和线段相交,分两种情况:   1. 如图A所示,当圆心与线段的距离大于圆的半径时,线段与圆肯定不相交 2. 如图B,C所示,两个端点都不在圆内,那么看圆心到线段...
  • Fire_to_cheat_
  • Fire_to_cheat_
  • 2017-08-26 21:03:18
  • 699

判断线段与圆是否相交

ACM模版判断线段与圆是否相交typedef long long ll; typedef struct // 点结构 { ll x, y; } Point;Point A, B, C, O...
  • f_zyj
  • f_zyj
  • 2016-07-29 17:11:04
  • 2527
收藏助手
不良信息举报
您举报文章:射线与球的相交性检测
举报原因:
原因补充:

(最多只允许输入30个字)