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 
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值