Python-opencv calcula el ángulo de dos líneas rectas o segmentos de línea

Python-opencv calcula el ángulo de dos líneas rectas o segmentos de línea

método uno

Calculada a través de la relación de pendiente, la fórmula es la siguiente:

Tenga cuidado de no aparecer vertical al calcular la pendiente. Los cálculos de Python informarán un error, pero debería ser posible calcular infinito. Dejémoslo aquí por ahora. Lo explicaré. más tarde cuando tenga tiempo razón.

#openpose求角度
def GetAngle(line1, line2):
    """
    计算两条线段之间的夹角，若已知两直线斜率：m1,m2
     angle = atan(abs((m2 - m1) / (1 + (m2 * m1)))
    :param line1:
    :param line2:
    :return:
    """
    dx1 = line1[0][0] - line1[1][0]
    dy1 = line1[0][1] - line1[1][1]
    dx2 = line2[0][0] - line2[1][0]
    dy2 = line2[0][1] - line2[1][1]

    #求斜率
    m1=dy1/dx1
    m2=dy2/dx2
    insideAngle=math.atan(abs((m2-m1)/(1+(m1*m2))))

    angle=insideAngle/math.pi*180
    if angle>-370 and angle<370:
        angle=int(angle)

    return angle

Método dos:

#openpose求角度
def GetAngle(line1, line2):
    """
    计算两条线段之间的夹角
    :param line1:
    :param line2:
    :return:
    """
    dx1 = line1[0][0] - line1[1][0]
    dy1 = line1[0][1] - line1[1][1]
    dx2 = line2[0][0] - line2[1][0]
    dy2 = line2[0][1] - line2[1][1]
    angle1 = math.atan2(dy1, dx1)
    angle1 = int(angle1 * 180 / math.pi)
    # print(angle1)
    angle2 = math.atan2(dy2, dx2)
    angle2 = int(angle2 * 180 / math.pi)
    # print(angle2)
    if angle1 * angle2 >= 0:
        insideAngle = abs(angle1 - angle2)
    else:
        insideAngle = abs(angle1) + abs(angle2)
        if insideAngle > 180:
            insideAngle = 360 - insideAngle
    insideAngle = insideAngle % 180
    return insideAngle

Método tres

Calcule el ángulo de tres puntos mediante el teorema del coseno:

si los tres lados son a, b, c, entonces, como se muestra en la figura, en △ABC:

Requisito previo para su uso: no tenga 0 en el denominador.

Implementación: forme un triángulo a través de tres puntos, primero calcule la longitud de cada lado y luego use la fórmula del coseno para resolver el ángulo

def DIST(p1,p2):
    '''
    func:求两点间距离
    @para p1,p2:点坐标(x1,y1),(x2,y2)
    @para return:距离
    '''
    return math.sqrt((p1[0]-p2[0])*(p1[0]-p2[0])+(p1[1]-p2[1])*(p1[1]-p2[1]))


# #openpose求角度
def GetAngle(p1,p2,p3):
    """
    若已知3点,求以中间点为原点的夹角
    :param p1,p2,p3:点坐标(x,y)
    :param return: 角度
    """
    #余弦定理求夹角
    A=DIST(p1,p2)
    B=DIST(p2,p3)
    C=DIST(p1,p3)

    angle=math.acos((A*A+B*B-C*C)/(2*A*B))
    return angle/math.pi*180