python通过三个球的坐标和半径寻找交点坐标

最新推荐文章于 2024-11-11 20:20:58 发布

原创

最新推荐文章于 2024-11-11 20:20:58 发布 · 376 阅读

1 ·

CC 4.0 BY-SA版权

文章标签：

#python #开发语言 #数学建模 #几何学

感谢Marc Pony的代数推导：求三个球面交点的高效解法_3个球面相交点-优快云博客

def find_intersection(x1, y1, z1, x2, y2, z2, x3, y3, z3, r1, r2, r3):
    a11 = 2 * (x3 - x1)
    a12 = 2 * (y3 - y1)
    a13 = 2 * (z3 - z1)
    b1 = (r1) ** 2 - (r3) ** 2 - (x1) ** 2 + (x3) ** 2 - (y1) ** 2 + (y3) ** 2 - (z1) ** 2 + (z3) ** 2
    a21 = 2 * (x3 - x2)
    a22 = 2 * (y3 - y2)
    a23 = 2 * (z3 - z2)
    b2 = (r2) ** 2 - (r3) ** 2 - (x2) ** 2 + (x3) ** 2 - (y2) ** 2 + (y3) ** 2 - (z2) ** 2 + (z3) ** 2

    p1 = (a12 * a23 - a13 * a22) / (a11 * a22 - a12 * a21)
    q1 = (a22 * b1 - a12 * b2) / (a11 * a22 - a12 * a21)
    p2 = (a13 * a21 - a11 * a23) / (a11 * a22 - a12 * a21)
    q2 = (a11 * b2 - a21 * b1) / (a11 * a22 - a12 * a21)

    tempA = p1 ** 2 + p2 ** 2 + 1
    tempB = 2 * (p1 * q1 - z3 + p2 * q2 - p1 * x3 - p2 * y3)
    tempC = q1 ** 2 - 2 * q1 * x3 + q2 ** 2 - 2 * q2