Найти точку пересечения прямых в пространстве

            //Создание точек из входных данных
        CoordPoints A = new CoordPoints(mCenterPoint);
            CoordPoints B = new CoordPoints(mVectorX.ArrayData);
            CoordPoints C = new CoordPoints(swCurveParaData.StartPoint);
            CoordPoints D = new CoordPoints(swCurveParaData.EndPoint);
 
            //Вычисление t
            double tX = GetNumber(A.x, B.x, C.x, D.x);
            double tY = GetNumber(A.y, B.y, C.y, D.y);
            double tZ = GetNumber(A.z, B.z, C.z, D.z);
 
            //   x=x1+t*(x2-x1)
            //   y=y1 +t(y2-y1)
            //   z=z1 +t(z2-z1)
            double X = A.x + tX*(B.x + A.x);
            double Y = A.y + tY*(B.y + A.y);
            double Z = A.z + tZ*(B.z + A.z);
           // Возврат точки пересечения на одной из отрезков
            return CreatePoint(new double[] {X, Y, Z});
        }
 
        private double GetNumber(double A, double B, double C, double D)
        {
            //T=(cx-ax)/(bx-ax-dx+cx)
            if (Double.IsNaN((C - A) / (B - A - D + C)))
            {
                return 0;
            }
            else
            {
                return (C - A) / (B - A - D + C);
            }
        }