PCK.py

import math
import numpy as np

def pck(holistic_tar, holistic, landmarks_tar, landmarks, percentage):
    
    heatmap_Score = []
    
    
    # calibration scale based on body length
    virtual_point2_tar = [(landmarks_tar[holistic_tar.PoseLandmark.RIGHT_HIP.value].x + landmarks_tar[holistic_tar.PoseLandmark.LEFT_HIP.value].x)/2,
                            (landmarks_tar[holistic_tar.PoseLandmark.RIGHT_HIP.value].y + landmarks_tar[holistic_tar.PoseLandmark.LEFT_HIP.value].y)/2]
    root_tar = virtual_point2_tar
    nose_tar = [landmarks_tar[holistic_tar.PoseLandmark.NOSE.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.NOSE.value].y-root_tar[1]]
    virtual_point_tar = [(landmarks_tar[holistic_tar.PoseLandmark.RIGHT_SHOULDER.value].x + landmarks_tar[holistic_tar.PoseLandmark.LEFT_SHOULDER.value].x)/2 -root_tar[0], (landmarks_tar[holistic_tar.PoseLandmark.RIGHT_SHOULDER.value].y + landmarks_tar[holistic_tar.PoseLandmark.LEFT_SHOULDER.value].y)/2 -root_tar[1]]
    right_wrist_tar = [landmarks_tar[holistic_tar.PoseLandmark.RIGHT_WRIST.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.RIGHT_WRIST.value].y-root_tar[1]]
    right_elbow_tar = [landmarks_tar[holistic_tar.PoseLandmark.RIGHT_ELBOW.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.RIGHT_ELBOW.value].y-root_tar[1]]
    right_shoulder_tar = [landmarks_tar[holistic_tar.PoseLandmark.RIGHT_SHOULDER.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.RIGHT_SHOULDER.value].y-root_tar[1]]
    left_wrist_tar = [landmarks_tar[holistic_tar.PoseLandmark.LEFT_WRIST.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.LEFT_WRIST.value].y-root_tar[1]]
    left_elbow_tar = [landmarks_tar[holistic_tar.PoseLandmark.LEFT_ELBOW.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.LEFT_ELBOW.value].y-root_tar[1]]
    left_shoulder_tar =[landmarks_tar[holistic_tar.PoseLandmark.LEFT_SHOULDER.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.LEFT_SHOULDER.value].y-root_tar[1]]
    right_hip_tar = [landmarks_tar[holistic_tar.PoseLandmark.RIGHT_HIP.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.RIGHT_HIP.value].y-root_tar[1]]
    right_knee_tar = [landmarks_tar[holistic_tar.PoseLandmark.RIGHT_KNEE.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.RIGHT_KNEE.value].y-root_tar[1]]
    right_ankle_tar = [landmarks_tar[holistic_tar.PoseLandmark.RIGHT_ANKLE.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.RIGHT_ANKLE.value].y-root_tar[1]]
    left_hip_tar = [landmarks_tar[holistic_tar.PoseLandmark.LEFT_HIP.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.LEFT_HIP.value].y-root_tar[1]]
    left_knee_tar = [landmarks_tar[holistic_tar.PoseLandmark.LEFT_KNEE.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.LEFT_KNEE.value].y-root_tar[1]]
    left_ankle_tar =[landmarks_tar[holistic_tar.PoseLandmark.LEFT_ANKLE.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.LEFT_ANKLE.value].y-root_tar[1]]
    virtual_point2_tar = [(landmarks_tar[holistic_tar.PoseLandmark.RIGHT_HIP.value].x + landmarks_tar[holistic_tar.PoseLandmark.LEFT_HIP.value].x)/2-root_tar[0],
                            (landmarks_tar[holistic_tar.PoseLandmark.RIGHT_HIP.value].y + landmarks_tar[holistic_tar.PoseLandmark.LEFT_HIP.value].y)/2-root_tar[1]]
    right_index_tar = [landmarks_tar[holistic_tar.PoseLandmark.RIGHT_INDEX.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.RIGHT_INDEX.value].y-root_tar[1]]
    left_index_tar = [landmarks_tar[holistic_tar.PoseLandmark.LEFT_INDEX.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.LEFT_INDEX.value].y-root_tar[1]]
    right_foot_index_tar =[landmarks_tar[holistic_tar.PoseLandmark.RIGHT_FOOT_INDEX.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.RIGHT_FOOT_INDEX.value].y-root_tar[1]]
    left_foot_index_tar =[landmarks_tar[holistic_tar.PoseLandmark.LEFT_FOOT_INDEX.value].x-root_tar[0],landmarks_tar[holistic_tar.PoseLandmark.LEFT_FOOT_INDEX.value].y-root_tar[1]]
    
    
    
    
    
    virtual_point2 = [(landmarks[holistic.PoseLandmark.RIGHT_HIP.value].x + landmarks[holistic.PoseLandmark.LEFT_HIP.value].x)/2,
                    (landmarks[holistic.PoseLandmark.RIGHT_HIP.value].y + landmarks[holistic.PoseLandmark.LEFT_HIP.value].y)/2]      
    root = virtual_point2
    nose = [landmarks[holistic.PoseLandmark.NOSE.value].x - root[0],landmarks[holistic.PoseLandmark.NOSE.value].y- root[1]]
    virtual_point = [(landmarks[holistic.PoseLandmark.RIGHT_SHOULDER.value].x + landmarks[holistic.PoseLandmark.LEFT_SHOULDER.value].x)/2- root[0],
                    (landmarks[holistic.PoseLandmark.RIGHT_SHOULDER.value].y + landmarks[holistic.PoseLandmark.LEFT_SHOULDER.value].y)/2- root[1]]
    right_wrist = [landmarks[holistic.PoseLandmark.RIGHT_WRIST.value].x- root[0],landmarks[holistic.PoseLandmark.RIGHT_WRIST.value].y- root[1], ]
    right_elbow = [landmarks[holistic.PoseLandmark.RIGHT_ELBOW.value].x- root[0],landmarks[holistic.PoseLandmark.RIGHT_ELBOW.value].y- root[1]]
    right_shoulder = [landmarks[holistic.PoseLandmark.RIGHT_SHOULDER.value].x- root[0],landmarks[holistic.PoseLandmark.RIGHT_SHOULDER.value].y- root[1]]
    left_wrist = [landmarks[holistic.PoseLandmark.LEFT_WRIST.value].x- root[0],landmarks[holistic.PoseLandmark.LEFT_WRIST.value].y- root[1]]
    left_elbow = [landmarks[holistic.PoseLandmark.LEFT_ELBOW.value].x- root[0],landmarks[holistic.PoseLandmark.LEFT_ELBOW.value].y- root[1]]
    left_shoulder =[landmarks[holistic.PoseLandmark.LEFT_SHOULDER.value].x- root[0],landmarks[holistic.PoseLandmark.LEFT_SHOULDER.value].y- root[1]]
    right_hip = [landmarks[holistic.PoseLandmark.RIGHT_HIP.value].x- root[0],landmarks[holistic.PoseLandmark.RIGHT_HIP.value].y- root[1]]
    right_knee = [landmarks[holistic.PoseLandmark.RIGHT_KNEE.value].x- root[0],landmarks[holistic.PoseLandmark.RIGHT_KNEE.value].y- root[1]]
    right_ankle = [landmarks[holistic.PoseLandmark.RIGHT_ANKLE.value].x- root[0],landmarks[holistic.PoseLandmark.RIGHT_ANKLE.value].y- root[1]]
    left_hip = [landmarks[holistic.PoseLandmark.LEFT_HIP.value].x- root[0],landmarks[holistic.PoseLandmark.LEFT_HIP.value].y- root[1]]
    left_knee = [landmarks[holistic.PoseLandmark.LEFT_KNEE.value].x- root[0],landmarks[holistic.PoseLandmark.LEFT_KNEE.value].y- root[1]]
    left_ankle =[landmarks[holistic.PoseLandmark.LEFT_ANKLE.value].x- root[0],landmarks[holistic.PoseLandmark.LEFT_ANKLE.value].y- root[1]]
    virtual_point2 = [(landmarks[holistic.PoseLandmark.RIGHT_HIP.value].x + landmarks[holistic.PoseLandmark.LEFT_HIP.value].x)/2-root[0],
                    (landmarks[holistic.PoseLandmark.RIGHT_HIP.value].y + landmarks[holistic.PoseLandmark.LEFT_HIP.value].y)/2-root[1]]  
    right_index = [landmarks[holistic.PoseLandmark.RIGHT_INDEX.value].x - root[0],landmarks[holistic.PoseLandmark.RIGHT_INDEX.value].y - root[1]]
    left_index = [landmarks[holistic.PoseLandmark.LEFT_INDEX.value].x- root[0],landmarks[holistic.PoseLandmark.LEFT_INDEX.value].y-root[1]]
    right_foot_index =[landmarks[holistic.PoseLandmark.RIGHT_FOOT_INDEX.value].x - root[0],landmarks[holistic.PoseLandmark.RIGHT_FOOT_INDEX.value].y - root[1]]
    left_foot_index =[landmarks[holistic.PoseLandmark.LEFT_FOOT_INDEX.value].x-root[0],landmarks[holistic.PoseLandmark.LEFT_FOOT_INDEX.value].y- root[1]]
    
    
    tar_len_x = (right_hip_tar[0] - left_shoulder_tar[0])
    tar_len_y = (right_hip_tar[1] - left_shoulder_tar[1])
    
    tar_len = math.sqrt(tar_len_x**2 + tar_len_y**2)
    
    
    len_x = (right_hip[0] - left_shoulder[0])
    len_y = (right_hip[1] - left_shoulder[1])
    
    tar_len = math.sqrt(tar_len_x**2 + tar_len_y**2)
    length = math.sqrt(len_x**2 + len_y**2)
    
    
    ratio = tar_len / length
    
    virtual_point2 = np.multiply(virtual_point2,ratio)   
    nose = np.multiply(nose,ratio) 
    virtual_point = np.multiply(virtual_point,ratio )
    right_wrist = np.multiply(right_wrist,ratio )
    right_elbow = np.multiply(right_elbow, ratio )
    right_shoulder =np.multiply( right_shoulder, ratio)
    left_wrist =np.multiply( left_wrist, ratio )
    left_elbow = np.multiply(left_elbow,  ratio )
    left_shoulder =np.multiply( left_shoulder, ratio)
    right_hip = np.multiply(right_hip, ratio)
    right_knee = np.multiply(right_knee, ratio )
    right_ankle = np.multiply(right_ankle, ratio)
    left_hip = np.multiply(left_hip, ratio )
    left_knee = np.multiply(left_knee, ratio )
    left_ankle = np.multiply(left_ankle, ratio)
    virtual_point2 = np.multiply(virtual_point2, ratio)
    
    right_index = np.multiply(right_index, ratio)
    left_index = np.multiply(left_index, ratio)
    right_foot_index = np.multiply(right_foot_index, ratio)
    left_foot_index = np.multiply(left_foot_index, ratio)
    
    
    circle_r_1 = percentage*tar_len*0.2
    circle_r_2 = percentage*tar_len*0.4
    circle_r_3 = percentage*tar_len*0.6
    circle_r_4 = percentage*tar_len*0.8
    circle_r = percentage*tar_len #  Criteria
    circle_r_6 = percentage*tar_len*1.2
    circle_r_7 = percentage*tar_len*1.4
    circle_r_8 = percentage*tar_len*1.6
    circle_r_9 = percentage*tar_len*1.8
    circle_r_10 = percentage*tar_len*2.0
    
    
    
    #print(f'dist = {circle_r}')
    print()
    
    # if math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r_1:
    #     print('vp2 100')
    # elif math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r_2:
    #     print('vp2 90')
    # elif math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r_3:
    #     print('vp2 80')
    # elif math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r_4:
    #     print('vp2 70')
    # elif math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r:
    #     print('vp2 60')
    # elif math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r_6:
    #     print('vp2 50')
    # elif math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r_7:
    #     print('vp2 40')
    # elif math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r_8:
    #     print('vp2 30')
    # elif math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r_9:
    #     print('vp2 20')
    # elif math.sqrt((virtual_point2_tar[0] - virtual_point2[0])**2 + (virtual_point2_tar[1] - virtual_point2[1])**2) <= circle_r_10:
    #     print('vp2 10')
    # else:
    #     print('vp2 out')
        
        
    if math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r_1:
        print('vp1 100')
        heatmap_Score.append(100)
    elif math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r_2:
        print('vp1 90')
        heatmap_Score.append(90)
    elif math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r_3:
        print('vp1 80')
        heatmap_Score.append(80)
    elif math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r_4:
        print('vp1 70')
        heatmap_Score.append(70)
    elif math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r:
        print('vp1 60')
        heatmap_Score.append(60)
    elif math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r_6:
        print('vp1 50')
        heatmap_Score.append(50)
    elif math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r_7:
        print('vp1 40')
        heatmap_Score.append(40)
    elif math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r_8:
        print('vp1 30')
        heatmap_Score.append(30)
    elif math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r_9:
        print('vp1 20')
        heatmap_Score.append(20)
    elif math.sqrt((virtual_point_tar[0] - virtual_point[0])**2 + (virtual_point_tar[1] - virtual_point[1])**2) <= circle_r_10:
        print('vp1 10')
        heatmap_Score.append(10)
    else:
        print('vp1 out')
        heatmap_Score.append(0)


    if math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r_1:
        print('nose 100')
        heatmap_Score.append(100)
    elif math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r_2:
        print('nose 90')
        heatmap_Score.append(90)
    elif math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r_3:
        print('nose 80')
        heatmap_Score.append(80)
    elif math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r_4:
        print('nose 70')
        heatmap_Score.append(70)
    elif math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r:
        print('nose 60')
        heatmap_Score.append(60)
    elif math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r_6:
        print('nose 50')
        heatmap_Score.append(50)
    elif math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r_7:
        print('nose 40')
        heatmap_Score.append(40)
    elif math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r_8:
        print('nose 30')
        heatmap_Score.append(30)
    elif math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r_9:
        print('nose 20')
        heatmap_Score.append(20)
    elif math.sqrt((nose_tar[0] - nose[0])**2 + (nose_tar[1] - nose[1])**2) <= circle_r_10:
        print('nose 10')
        heatmap_Score.append(10)
    else:
        print('nose out')
        heatmap_Score.append(0)        
        
        
        
    if math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r_1:
        print('right wrist 100')
        heatmap_Score.append(100)
    elif math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r_2:
        print('right wrist 90')
        heatmap_Score.append(90)
    elif math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r_3:
        print('right wrist 80')
        heatmap_Score.append(80)
    elif math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r_4:
        print('right wrist 70')
        heatmap_Score.append(70)
    elif math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r:
        print('right wrist 60')
        heatmap_Score.append(60)
    elif math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r_6:
        print('right wrist 50')
        heatmap_Score.append(50)
    elif math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r_7:
        print('right wrist 40')
        heatmap_Score.append(40)
    elif math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r_8:
        print('right wrist 30')
        heatmap_Score.append(30)
    elif math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r_9:
        print('right wrist 20')
        heatmap_Score.append(20)
    elif math.sqrt((right_wrist_tar[0] - right_wrist[0])**2 + (right_wrist_tar[1] - right_wrist[1])**2) <= circle_r_10:
        print('right wrist 10')
        heatmap_Score.append(10)
    else:
        print('right wrist out')
        heatmap_Score.append(0)
        
        
        
    if math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r_1:
        print('right elbow 100')
        heatmap_Score.append(100)
    elif math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r_2:
        print('right elbow 90')
        heatmap_Score.append(90)
    elif math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r_3:
        print('right elbow 80')
        heatmap_Score.append(80)
    elif math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r_4:
        print('right elbow 70')
        heatmap_Score.append(70)
    elif math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r:
        print('right elbow 60')
        heatmap_Score.append(60)
    elif math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r_6:
        print('right elbow 50')
        heatmap_Score.append(50)
    elif math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r_7:
        print('right elbow 40')
        heatmap_Score.append(40)
    elif math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r_8:
        print('right elbow 30')
        heatmap_Score.append(30)
    elif math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r_9:
        print('right elbow 20')
        heatmap_Score.append(20)
    elif math.sqrt((right_elbow_tar[0] - right_elbow[0])**2  + (right_elbow_tar[1] - right_elbow[1])**2) <= circle_r_10:
        print('right elbow 10')
        heatmap_Score.append(10)
    else:
        print('right elbow out')
        heatmap_Score.append(0)


        
    # if math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r_1:
    #     print('right shoulder 100')
    # elif math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r_2:
    #     print('right shoulder 90')
    # elif math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r_3:
    #     print('right shoulder 80')
    # elif math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r_4:
    #     print('right shoulder 70')
    # elif math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r:
    #     print('right shoulder 60')
    # elif math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r_6:
    #     print('right shoulder 50')
    # elif math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r_7:
    #     print('right shoulder 40')
    # elif math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r_8:
    #     print('right shoulder 30')
    # elif math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r_9:
    #     print('right shoulder 20')
    # elif math.sqrt((right_shoulder_tar[0] - right_shoulder[0])**2+ (right_shoulder_tar[1] - right_shoulder[1])**2) <= circle_r_10:
    #     print('right shoulder 10')
    # else:
    #     print('right shoulder out')
        
        
        
        
        
    if math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] - left_wrist[1])**2) <= circle_r_1:
        print('left wrist 100')
        heatmap_Score.append(100)
    elif math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] - left_wrist[1])**2) <= circle_r_2:
        print('left wrist 90')
        heatmap_Score.append(90)
    elif math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] - left_wrist[1])**2) <= circle_r_3:
        print('left wrist 80')
        heatmap_Score.append(80)
    elif math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] -left_wrist[1])**2) <= circle_r_4:
        print('left wrist 70')
        heatmap_Score.append(70)
    elif math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] - left_wrist[1])**2) <= circle_r:
        print('left wrist 60')
        heatmap_Score.append(60)
    elif math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] - left_wrist[1])**2) <= circle_r_6:
        print('left wrist 50')
        heatmap_Score.append(50)
    elif math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] - left_wrist[1])**2) <= circle_r_7:
        print('left wrist 40')
        heatmap_Score.append(40)
    elif math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] - left_wrist[1])**2) <= circle_r_8:
        print('left wrist 30')
        heatmap_Score.append(30)
    elif math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] - left_wrist[1])**2) <= circle_r_9:
        print('left wrist 20')
        heatmap_Score.append(20)
    elif math.sqrt((left_wrist_tar[0] - left_wrist[0])**2 + (left_wrist_tar[1] - left_wrist[1])**2) <= circle_r_10:
        print('left wrist 10')
        heatmap_Score.append(10)
    else:
        print('left wrist out')
        heatmap_Score.append(0)
        
        
    if math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] - left_elbow[1])**2) <= circle_r_1:
        print('left elbow 100')
        heatmap_Score.append(100)
    elif math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] - left_elbow[1])**2) <= circle_r_2:
        print('left elbow 90')
        heatmap_Score.append(90)
    elif math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] - left_elbow[1])**2) <= circle_r_3:
        print('left elbow 80')
        heatmap_Score.append(80)
    elif math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] -left_elbow[1])**2) <= circle_r_4:
        print('left elbow 70')
        heatmap_Score.append(70)
    elif math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] - left_elbow[1])**2) <= circle_r:
        print('left elbow 60')
        heatmap_Score.append(60)
    elif math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] - left_elbow[1])**2) <= circle_r_6:
        print('left elbow 50')
        heatmap_Score.append(50)
    elif math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] - left_elbow[1])**2) <= circle_r_7:
        print('left elbow 40')
        heatmap_Score.append(40)
    elif math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] - left_elbow[1])**2) <= circle_r_8:
        print('left elbow 30')
        heatmap_Score.append(30)
    elif math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] - left_elbow[1])**2) <= circle_r_9:
        print('left elbow 20')
        heatmap_Score.append(20)
    elif math.sqrt((left_elbow_tar[0] - left_elbow[0])**2  + (left_elbow_tar[1] - left_elbow[1])**2) <= circle_r_10:
        print('left elbow 10')
        heatmap_Score.append(10)
    else:
        print('left elbow out')
        heatmap_Score.append(0)


        
    # if math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r_1:
    #     print('left shoulder 100')
    # elif math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r_2:
    #     print('left shoulder 90')
    # elif math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r_3:
    #     print('left shoulder 80')
    # elif math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r_4:
    #     print('left shoulder 70')
    # elif math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r:
    #     print('left shoulder 60')
    # elif math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r_6:
    #     print('left shoulder 50')
    # elif math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r_7:
    #     print('left shoulder 40')
    # elif math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r_8:
    #     print('left shoulder 30')
    # elif math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r_9:
    #     print('left shoulder 20')
    # elif math.sqrt((left_shoulder_tar[0] - left_shoulder[0])**2+ (left_shoulder_tar[1] - left_shoulder[1])**2) <= circle_r_10:
    #     print('left shoulder 10')
    # else:
    #     print('left shoulder out')
        
        
        
        
        
    
    
    

    # if math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r_1:
    #     print('right hip 100')
    # elif math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r_2:
    #     print('right hip 90')
    # elif math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r_3:
    #     print('right hip 80')
    # elif math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r_4:
    #     print('right hip 70')
    # elif math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r:
    #     print('right hip 60')
    # elif math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r_6:
    #     print('right hip 50')
    # elif math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r_7:
    #     print('right hip 40')
    # elif math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r_8:
    #     print('right hip 30')
    # elif math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r_9:
    #     print('right hip 20')
    # elif math.sqrt((right_hip_tar[0] - right_hip[0])**2 + (right_hip_tar[1] - right_hip[1])**2) <= circle_r_10:
    #     print('right hip 10')
    # else:
    #     print('right hip out')
        
        
        
    if math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r_1:
        print('right knee 100')
        heatmap_Score.append(100)
    elif math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r_2:
        print('right knee 90')
        heatmap_Score.append(90)
    elif math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r_3:
        print('right knee 80')
        heatmap_Score.append(80)
    elif math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r_4:
        print('right knee 70')
        heatmap_Score.append(70)
    elif math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r:
        print('right knee 60')
        heatmap_Score.append(60)
    elif math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r_6:
        print('right knee 50')
        heatmap_Score.append(50)
    elif math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r_7:
        print('right knee 40')
        heatmap_Score.append(40)
    elif math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r_8:
        print('right knee 30')
        heatmap_Score.append(30)
    elif math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r_9:
        print('right knee 20')
        heatmap_Score.append(20)
    elif math.sqrt((right_knee_tar[0] - right_knee[0])**2  + (right_knee_tar[1] - right_knee[1])**2) <= circle_r_10:
        print('right knee 10')
        heatmap_Score.append(10)
    else:
        print('right knee out')
        heatmap_Score.append(0)


        
    if math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r_1:
        print('right ankle 100')
        heatmap_Score.append(100)
    elif math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r_2:
        print('right ankle 90')
        heatmap_Score.append(90)
    elif math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r_3:
        print('right ankle 80')
        heatmap_Score.append(80)
    elif math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r_4:
        print('right ankle 70')
        heatmap_Score.append(70)
    elif math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r:
        print('right ankle 60')
        heatmap_Score.append(60)
    elif math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r_6:
        print('right ankle 50')
        heatmap_Score.append(50)
    elif math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r_7:
        print('right ankle 40')
        heatmap_Score.append(40)
    elif math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r_8:
        print('right ankle 30')
        heatmap_Score.append(30)
    elif math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r_9:
        print('right ankle 20')
        heatmap_Score.append(20)
    elif math.sqrt((right_ankle_tar[0] - right_ankle[0])**2+ (right_ankle_tar[1] - right_ankle[1])**2) <= circle_r_10:
        print('right ankle 10')
        heatmap_Score.append(10)
    else:
        print('right ankle out')
        heatmap_Score.append(0)


    # if math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r_1:
    #     print('left hip 100')
    # elif math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r_2:
    #     print('left hip 90')
    # elif math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r_3:
    #     print('left hip 80')
    # elif math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r_4:
    #     print('left hip 70')
    # elif math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r:
    #     print('left hip 60')
    # elif math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r_6:
    #     print('left hip 50')
    # elif math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r_7:
    #     print('left hip 40')
    # elif math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r_8:
    #     print('left hip 30')
    # elif math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r_9:
    #     print('left hip 20')
    # elif math.sqrt((left_hip_tar[0] - left_hip[0])**2 + (left_hip_tar[1] - left_hip[1])**2) <= circle_r_10:
    #     print('left hip 10')
    # else:
    #     print('left hip out')
        
        
        
    if math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r_1:
        print('left knee 100')
        heatmap_Score.append(100)
    elif math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r_2:
        print('left knee 90')
        heatmap_Score.append(90)
    elif math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r_3:
        print('left knee 80')
        heatmap_Score.append(80)
    elif math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r_4:
        print('left knee 70')
        heatmap_Score.append(70)
    elif math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r:
        print('left knee 60')
        heatmap_Score.append(60)
    elif math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r_6:
        print('left knee 50')
        heatmap_Score.append(50)
    elif math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r_7:
        print('left knee 40')
        heatmap_Score.append(40)
    elif math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r_8:
        print('left knee 30')
        heatmap_Score.append(30)
    elif math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r_9:
        print('left knee 20')
        heatmap_Score.append(20)
    elif math.sqrt((left_knee_tar[0] - left_knee[0])**2  + (left_knee_tar[1] - left_knee[1])**2) <= circle_r_10:
        print('left knee 10')
        heatmap_Score.append(10)
    else:
        print('left knee out')
        heatmap_Score.append(0)


        
    if math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r_1:
        print('left ankle 100')
        heatmap_Score.append(100)
    elif math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r_2:
        print('left ankle 90')
        heatmap_Score.append(90)
    elif math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r_3:
        print('left ankle 80')
        heatmap_Score.append(80)
    elif math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r_4:
        print('left ankle 70')
        heatmap_Score.append(70)
    elif math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r:
        print('left ankle 60')
        heatmap_Score.append(60)
    elif math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r_6:
        print('left ankle 50')
        heatmap_Score.append(50)
    elif math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r_7:
        print('left ankle 40')
        heatmap_Score.append(40)
    elif math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r_8:
        print('left ankle 30')
        heatmap_Score.append(30)
    elif math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r_9:
        print('left ankle 20')
        heatmap_Score.append(20)
    elif math.sqrt((left_ankle_tar[0] - left_ankle[0])**2+ (left_ankle_tar[1] - left_ankle[1])**2) <= circle_r_10:
        print('left ankle 10')
        heatmap_Score.append(10)
    else:
        print('left ankle out')
        heatmap_Score.append(0)
        
        
        
##################################################################################################################################

#
    if math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r_1:
        print('right index 100')
        heatmap_Score.append(100)
    elif math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r_2:
        print('right index 90')
        heatmap_Score.append(90)
    elif math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r_3:
        print('right index 80')
        heatmap_Score.append(80)
    elif math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r_4:
        print('right index 70')
        heatmap_Score.append(70)
    elif math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r:
        print('right index 60')
        heatmap_Score.append(60)
    elif math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r_6:
        print('right index 50')
        heatmap_Score.append(50)
    elif math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r_7:
        print('right index 40')
        heatmap_Score.append(40)
    elif math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r_8:
        print('right index 30')
        heatmap_Score.append(30)
    elif math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r_9:
        print('right index 20')
        heatmap_Score.append(20)
    elif math.sqrt((right_index_tar[0] - right_index[0])**2+ (right_index_tar[1] - right_index[1])**2) <= circle_r_10:
        print('right index 10')
        heatmap_Score.append(10)
    else:
        print('right index out')
        heatmap_Score.append(0)



##
    if math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r_1:
        print('left index 100')
        heatmap_Score.append(100)
    elif math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r_2:
        print('left index 90')
        heatmap_Score.append(90)
    elif math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r_3:
        print('left index 80')
        heatmap_Score.append(80)
    elif math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r_4:
        print('left index 70')
        heatmap_Score.append(70)
    elif math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r:
        print('left index 60')
        heatmap_Score.append(60)
    elif math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r_6:
        print('left index 50')
        heatmap_Score.append(50)
    elif math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r_7:
        print('left index 40')
        heatmap_Score.append(40)
    elif math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r_8:
        print('left index 30')
        heatmap_Score.append(30)
    elif math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r_9:
        print('left index 20')
        heatmap_Score.append(20)
    elif math.sqrt((left_index_tar[0] - left_index[0])**2+ (left_index_tar[1] - left_index[1])**2) <= circle_r_10:
        print('left index 10')
        heatmap_Score.append(10)
    else:
        print('left index out')
        heatmap_Score.append(0)


###
    if math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r_1:
        print('right foot index 100')
        heatmap_Score.append(100)
    elif math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r_2:
        print('right foot index 90')
        heatmap_Score.append(90)
    elif math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r_3:
        print('right foot index 80')
        heatmap_Score.append(80)
    elif math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r_4:
        print('right foot index 70')
        heatmap_Score.append(70)
    elif math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r:
        print('right foot index 60')
        heatmap_Score.append(60)
    elif math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r_6:
        print('right foot index 50')
        heatmap_Score.append(50)
    elif math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r_7:
        print('right foot index 40')
        heatmap_Score.append(40)
    elif math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r_8:
        print('right foot index 30')
        heatmap_Score.append(30)
    elif math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r_9:
        print('right foot index 20')
        heatmap_Score.append(20)
    elif math.sqrt((right_foot_index_tar[0] - right_foot_index[0])**2+ (right_foot_index_tar[1] - right_foot_index[1])**2) <= circle_r_10:
        print('right foot index 10')
        heatmap_Score.append(10)
    else:
        print('right foot index out')
        heatmap_Score.append(0)
        
        
        
        
        
####
    if math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r_1:
        print('left foot index 100')
        heatmap_Score.append(100)
    elif math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r_2:
        print('left foot index 90')
        heatmap_Score.append(90)
    elif math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r_3:
        print('left foot index 80')
        heatmap_Score.append(80)
    elif math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r_4:
        print('left foot index 70')
        heatmap_Score.append(70)
    elif math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r:
        print('left foot index 60')
        heatmap_Score.append(60)
    elif math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r_6:
        print('left foot index 50')
        heatmap_Score.append(50)
    elif math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r_7:
        print('left foot index 40')
        heatmap_Score.append(40)
    elif math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r_8:
        print('left foot index 30')
        heatmap_Score.append(30)
    elif math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r_9:
        print('left foot index 20')
        heatmap_Score.append(20)
    elif math.sqrt((left_foot_index_tar[0] - left_foot_index[0])**2+ (left_foot_index_tar[1] - left_foot_index[1])**2) <= circle_r_10:
        print('left foot index 10')
        heatmap_Score.append(10)
    else:
        print('left foot index out')
        heatmap_Score.append(0)



    print('---------------------------------------------------------------------------------------------------------------')




####################################################################################################################################################################
    return heatmap_Score # 순서대로 [vp1, nose, right_wrist, right_elbow, left_wrist, left_elbow, right_knee, right_ankle, left_knee, left_ankle, right_index, left_index, right_foot_index, left_foot_index]