173 lines
6.4 KiB
Python
173 lines
6.4 KiB
Python
# 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)
|
|
|
|
|
|
# ------------------------------------------------------------------------------------------------------------------------------------------
|