0

我有 2 个向量，每个向量由 2 Point3D（原点和方向）定义。我需要找出他们的交点。一点点帮助总是受欢迎的。我将发布我的函数，这给了我错误的输出。

public static CurvIntersect3D Intersect2Linii3D (Vector3D dr1, Vector3D dr2) {
    CurvIntersect3D result = new CurvIntersect3D(0, null);

    double x = Math3D.VectorNorm3D(dr1.getDirectie());
    double t = Math3D.VectorNorm3D(dr2.getDirectie());
    double cosa = (dr1.getDirectie().getX()*dr2.getDirectie().getX() + dr1.getDirectie().getY()*dr2.getDirectie().getY() + dr1.getDirectie().getZ()*dr2.getDirectie().getZ()) / (t*x);
    Punct3D p1 = dr1.getOrigine();
    Punct3D p2 = new Punct3D(), p3 = new Punct3D();
    for (int i=0; i<3; i++)
    {
        p2.set(i, dr1.getOrigine().get(i) + dr1.getDirectie().get(i));
        p3.set(i, dr1.getOrigine().get(i) + dr2.getDirectie().get(i));
    }

    Matrici.Matrice3x3 rot = Math3D.GetMatriceRotatie(p1, p2, p3);
    Punct3D orig = new Punct3D();
    for (int i=0; i<3; i++)
        orig.set(i, rot.getElement(i, 0) * (dr2.getOrigine().getX()-dr1.getOrigine().getX()) +
                    rot.getElement(i, 1) * (dr2.getOrigine().getY()-dr1.getOrigine().getY()) +
                    rot.getElement(i, 2) * (dr2.getOrigine().getZ()-dr1.getOrigine().getZ()));

    x = orig.getY() - orig.getZ()* cosa / Math.sqrt(1 - cosa*cosa);
    p1 = new Punct3D();
    for (int i=0; i<3; i++)
        p1.set(i, dr1.getOrigine().get(i) + x*dr1.getDirectie().get(i));
    result.setCount(1);
    result.add(p1);
    return result;
}

CurvIntersec3D 是一个存储点数组及其长度的结构。

4

2 回答 2

9

如前所述，两条线可能不会在一个点相交。一般来说，您可以做的最好的事情是在 line1 上找到最接近 line2 的点，反之亦然。连接这两个点以创建共同的法线方向。

给定两条穿过 3D 点r1=[r1x,r1y,r1z]并r2=[r2x,r2y,r2z]具有单位方向的线e1=[e1x,e1y,e1z]，e2=[e2x,e2y,e2z]您可以找到线上最接近另一条线的点，如下所示：

  1. 找到方向投影u=Dot(e1,e2)=e1x*e2x+e1y*e2y+e1z*e2z
  2. 如果u==1那么线是平行的。不存在交叉点。
  3. 找到分离投影t1=Dot(r2-r1,e1)和t2=Dot(r2-r1,e2)
  4. 沿 line1 查找距离d1 = (t1-u*t2)/(1-u*u)
  5. 沿 line2 查找距离d2 = (t2-u*t1)/(u*u-1)
  6. 找到 line1 上的点p1=Add(r1,Scale(d1,e1))
  7. 找到 line2 上的点p2=Add(r2,Scale(d2,e2))

注意：您必须将方向作为单位向量，Dot(e1,e1)=1并且Dot(e2,e2)=1。该函数Dot()是向量点积。该函数Add()将向量的分量相加，该函数将向量Scale()的分量与一个数字相乘。

祝你好运。

于 2012-05-11T15:41:19.047 回答
0

你确定你的线有交点吗？

如果有保证，那么问题就相当简单：获取线的参数方程，求解两个线性方程组，如下所示：

A_X0+t*A_Dir_X = B_X0+u*B_DirX ，其中 X0 是基点，Dir 是方向向量（考虑任何具有非零叉积的坐标对）

如果不是，那么首先需要计算两条斜线之间的距离。如果距离为零，那么我们可以找到交点。

于 2012-05-11T13:55:02.553 回答