# https://raw.githubusercontent.com/hafizas101/Real-time-human-pose-estimation-and-classification/master/main.py # From Python # It requires OpenCV installed for Python import sys import cv2 import os from sys import platform import argparse from math import sqrt, acos, degrees, atan, degrees import numpy as np # ----------------------------------------- Arslan Part ---------------------------------------------------------------------------------- def get_angle(a,b): #print(a) #print(b) del_y = a[1]-b[1] del_x = b[0]-a[0] if del_x == 0: del_x = 0.1 #print("Del_X : "+str(del_x)+"-----Del_Y: "+str(del_y)) angle = 0 if del_x > 0 and del_y > 0: angle = degrees(atan(del_y / del_x)) elif del_x < 0 and del_y > 0: angle = degrees(atan(del_y / del_x)) + 180 return angle # ------------------------------------------------------------------------------------------------------------------------------------------ # ----------------------------------------- Maksim Part ---------------------------------------------------------------------------------- def angle_gor(a,b,c,d): ab=[a[0]-b[0],a[1]-b[1]] ab1=[c[0]-d[0],c[1]-d[1]] cos=abs(ab[0]*ab1[0]+ab[1]*ab1[1])/(sqrt(ab[0]**2+ab[1]**2)*sqrt(ab1[0]**2+ab1[1]**2)) ang = acos(cos) return ang*180/np.pi def sit_ang(a,b,c,d): ang=angle_gor(a,b,c,d) s1=0 if ang != None: #print("Angle",ang) if ang < 120 and ang>40: s1=1 return s1 def sit_rec(a,b,c,d): ab = [a[0] - b[0], a[1] - b[1]] ab1 = [c[0] - d[0], c[1] - d[1]] l1=sqrt(ab[0]**2+ab[1]**2) l2=sqrt(ab1[0]**2+ab1[1]**2) s=0 if l1!=0 and l2!=0: #print(l1,l2, "---------->>>") if l2/l1>=1.5: s=1 return s # ------------------------------------------------------------------------------------------------------------------------------------------ # ----------------------------------------------------------- OpenPose Example Code ---------------------------------------------------------- # Import Openpose (Windows/Ubuntu/OSX) dir_path = os.path.dirname(os.path.realpath(__file__)) try: # Windows Import if platform == "win32": # Change these variables to point to the correct folder (Release/x64 etc.) sys.path.append(dir_path + '/../../python/openpose/Release'); os.environ['PATH'] = os.environ['PATH'] + ';' + dir_path + '/../../x64/Release;' + dir_path + '/../../bin;' import pyopenpose as op else: # Change these variables to point to the correct folder (Release/x64 etc.) sys.path.append('../../python'); # If you run `make install` (default path is `/usr/local/python` for Ubuntu), you can also access the OpenPose/python module from there. This will install OpenPose and the python library at your desired installation path. Ensure that this is in your python path in order to use it. # sys.path.append('/usr/local/python') from openpose import pyopenpose as op except ImportError as e: print('Error: OpenPose library could not be found. Did you enable `BUILD_PYTHON` in CMake and have this Python script in the right folder?') raise e # Flags parser = argparse.ArgumentParser() parser.add_argument("--image_path", default="../../../examples/media/COCO_val2014_000000000192.jpg", help="Process an image. Read all standard formats (jpg, png, bmp, etc.).") args = parser.parse_known_args() # Custom Params (refer to include/openpose/flags.hpp for more parameters) params = dict() params["model_folder"] = "/home/nvidia/openpose/models/" # Add others in path? for i in range(0, len(args[1])): curr_item = args[1][i] if i != len(args[1])-1: next_item = args[1][i+1] else: next_item = "1" if "--" in curr_item and "--" in next_item: key = curr_item.replace('-','') if key not in params: params[key] = "1" elif "--" in curr_item and "--" not in next_item: key = curr_item.replace('-','') if key not in params: params[key] = next_item # Construct it from system arguments # op.init_argv(args[1]) # oppython = op.OpenposePython() c=0 # Starting OpenPose opWrapper = op.WrapperPython() opWrapper.configure(params) opWrapper.start() # ------------------------------------------------------- OUR CONTRIBUTIONS ---------------------------------------------------------------- cam = cv2.VideoCapture(1) for i in range(1000): # Process Image datum = op.Datum() s, im = cam.read() # captures image #cv2.imshow("Test Picture", im) # displays captured image #im=cv2.resize(im,(480,270), interpolation = cv2.INTER_AREA) image1 = im #imageToProcess = cv2.imread(args[0].image_path) c+=1 if c==8: c=0 datum.cvInputData = image1 opWrapper.emplaceAndPop([datum]) # OpenPose being applied to the frame image. # Display Image #print("Body keypoints: \n" + str(datum.poseKeypoints)) #print(datum.poseKeypoints.shape) if len(datum.poseKeypoints.shape)>=2: x1=0 x2=0 for j in range(len(datum.poseKeypoints)): x1=0 x2=0 s=0 s1=0 ang1 = get_angle(datum.poseKeypoints[j][3], datum.poseKeypoints[j][4]) ang2 = get_angle(datum.poseKeypoints[j][6], datum.poseKeypoints[j][7]) if (30 < ang1 < 150): x1 = 1 if (30 < ang2 < 150): x2 = 1 x3 = x1+x2 if (x3 == 1): print("The {} person says: HELLO !".format(j+1)) #cv2.putText(datum.cvOutputData,'OpenPose using Python-OpenCV',(20,30), cv2.FONT_HERSHEY_SIMPLEX, 1,(255,255,255),1,cv2.LINE_AA) elif (x3 == 2): print("The {} person says: STOP PLEASE !".format(j+1)) s += sit_rec(datum.poseKeypoints[j][9], datum.poseKeypoints[j][10],datum.poseKeypoints[j][10],datum.poseKeypoints[j][11]) s += sit_rec(datum.poseKeypoints[j][12], datum.poseKeypoints[j][13],datum.poseKeypoints[j][13],datum.poseKeypoints[j][14]) s1+=sit_ang(datum.poseKeypoints[j][9], datum.poseKeypoints[j][10],datum.poseKeypoints[j][10],datum.poseKeypoints[j][11]) s1+=sit_ang(datum.poseKeypoints[j][12], datum.poseKeypoints[j][13],datum.poseKeypoints[j][13],datum.poseKeypoints[j][14]) if s > 0 or s1>0: print("The {} person is sitting".format(j+1)) if s == 0 and s1 == 0: print("The {} person is standing".format(j+1)) print("___________________________") print(" ") im=cv2.resize(datum.cvOutputData,(960,540), interpolation = cv2.INTER_AREA) cv2.imshow("OpenPose 1.4.0 - Tutorial Python API", im) cv2.waitKey(1) # ------------------------------------------------------------------------------------------------------------------------------------------