c# - 获取2个圆的交点

我需要能够计算2个圆之间的交点。我知道肯定会有2个相交点。不是1，不是0，不是无限，总是2。这是我要执行的操作的图表：



这是我目前的尝试：

public static List<Vector2> intersect(Vector3 c1, Vector3 c2, float rad1, float rad2)
{
    List<Vector2> rLp = new List<Vector2>();
    float d = Vector2.Distance(c1, c2);

    if (d > (rad1 + rad2))
        return rLp;
    else if (d == 0 && rad1 == rad2)
        return rLp;
    else if ((d + Mathf.Min(rad1, rad2)) < Mathf.Max(rad1, rad2))
        return rLp;
    else
    {
        float a = (rad1 * rad1 - rad2 * rad2 + d * d) / (2 * d);
        float h = Mathf.Sqrt(rad1 * rad1 - a * a);

        Vector2 p2 = new Vector2((float)(c1.x + (a * (c2.x - c1.x)) / d), (float)(c1.y + (a * c2.y - c1.y) / d));

        Vector2 i1 = new Vector2((float)(p2.x + (h * (c2.y - c1.y)) / d), (float)(p2.y - (h * (c2.x - c1.x)) / d));
        Vector2 i2 = new Vector2((float)(p2.x - (h * (c2.y - c1.y)) / d), (float)(p2.y + (h * (c2.x - c1.x)) / d));

        if (d == (rad1 + rad2))
            rLp.Add(i1);
        else
        {
            rLp.Add(i1);
            rLp.Add(i2);
        }

        return rLp;
    }
}

它给我以下结果：



如您所见，代表两个圆圈之间的拦截点的白色正方形在错误的位置。我真的可以在这方面使用一些帮助。谁能看到什么问题？

最佳答案

对我而言，复制和粘贴数学代码几乎总是出错（例如，定义中的翻转符号等）。从其他人调试这样的代码简直是恐怖（当深入到数学中时，调试我自己的代码就很难了）。您应该尝试自己进行计算并将其转换为代码。如果出了问题，您可以使用调试器进行调试，并使用袖珍计算器进行交叉检查。

您确实应该自己尝试。拿一张纸，算对数学。但是这是我会使用的方法：

private void intersectionTwoCircles(double c1x, double c1y, double r1, double c2x, double c2y, double r2,
        out double a1x, out double a1y, out double a2x, out double a2y)
    {
        /* error handling is missing complettely - left as an exercise

              A1
             /| \
         r1 / |  \ r2
           /  |   \
          /   |h   \
         /g1  |     \          (g1 means angle gamma1)
        C1----P-----C2
           d1   d2
        */
        double dx = c1x - c2x;
        double dy = c1y - c2y;
        double d = Math.Sqrt(dx*dx + dy*dy); // d = |C1-C2|
        double gamma1 = Math.Acos((r2*r2 + d*d - r1*r1)/(2*r2*d)); // law of cosines
        double d1 = r1*Math.Cos(gamma1); // basic math in right triangle
        double h = r1*Math.Sin(gamma1);
        double px = c1x + (c2x - c1x) / d*d1;
        double py = c1y + (c2y - c1y) / d*d1;
        // (-dy, dx)/d is (C2-C1) normalized and rotated by 90 degrees
        a1x = px + (-dy)/d*h;
        a1y = py + (+dx) / d * h;
        a2x = px - (-dy) / d * h;
        a2y = py - (+dx) / d * h;
    }

提供代码后更新：

您的方法与我的方法非常相似（a=r1 cos(gamma_1)和h=r1 sin(gamma_1)）。您只是避免直接计算gamma。它更快（仅一个sqrt而不是cos，sin和acos）。但是我认为，我的代码更具可读性;）考虑重载向量类的操作数（+，-，*，...）...您的代码将变得更容易阅读。

而且我想我已经找到了您的错误...。

// before
Vector2 p2 = new Vector2((float)(c1.x + (a * (c2.x - c1.x)) / d), (float)(c1.y + (a * c2.y - c1.y) / d));

// after
Vector2 p2 = new Vector2((float)(c1.x + (a * (c2.x - c1.x)) / d), (float)(c1.y + a * (c2.y - c1.y) / d));