Python - 两圆相交求交点坐标
Max.Bai
2016-05-16
Python - 两圆相交求交点坐标
三轴机械臂求坐标问题,其实转化为平面问题就是两圆相交求交点问题,交点算出来就可以用反三角函数算出各个机械臂的夹角。
已知圆1, 半径R, 坐标(x, y)
圆2, 半径S, 坐标(a, b)
求两圆交点x3, y3 x4, y4。
算法一脚本:
# -*- coding: utf-8 -*-
import math
def sq(x):
return float(x * x)
# target point on table
tx = float(10)
ty = float(10)
# hight of table
h0 = float(