#openpose求角度
def GetAngle(line1, line2):
    """
    計(jì)算兩條線(xiàn)段之間的夾角，若已知兩直線(xiàn)斜率：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

#openpose求角度
def GetAngle(line1, line2):
    """
    計(jì)算兩條線(xiàn)段之間的夾角
    :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

def DIST(p1,p2):
    '''
    func:求兩點(diǎn)間距離
    @para p1,p2:點(diǎn)坐標(biāo)(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點(diǎn),求以中間點(diǎn)為原點(diǎn)的夾角
    :param p1,p2,p3:點(diǎn)坐標(biāo)(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