import math import time import numpy as np from MCamera.mp_camera import * from MCamera.camera import * from Database.manager_database import * from score_doc import get_fin_score from .base_exercise import BaseExercise class PullUp_1(BaseExercise): def __init__(self, info, statistic_time=120, camera=None): super().__init__(info, statistic_time, camera=camera) # 个数统计 self.bar = None self.per = None self.count = 0 # 当前状态 self.body_state = 0 self.direction = 0 self.is_storard = 1 # 动作持续帧数 self._time = 0 self.time = 0 self.t = 0 self.starttime = 0 # 开始标志 self.form = 0 # 状态反馈 self.pre_pos = 0 self.sta_time = time.time() self.feedback = "开始" self.exercise_type = "引体向上" self.end_test = 0 self.had_done = False self.time_1 = 0 # 摆动状态 self.state = 0 # 初始化 self.initial_height_left = 0 self.initial_height_right = 0 self.initial_wrist_1_y = 0 self.initial_wrist_2_y = 0 # 引体向上参数 self.corner = (0, 480, 240, 400) MediapipeAlgorithmPlugin.set_corner(corner=self.corner) MediapipeAlgorithmPlugin.set_config(config=self.config) self.a = time.time() self.b = 0 def get_result(self): # 人员年龄 age = self.info.get(AGE) # 人员性别 gender = "woman" if self.info.get(GENDER) == "女" else "man" score = get_fin_score.Military(gender, int(age), integratedProjectResult=int(self.count)).IntegratedProjectScoreEvaluation() if self.starttime != 0: this_time = time.time() count_time = this_time - self.starttime else: count_time = 0 result = { "count": int(self.count), "score": score, "had_done": self.had_done, 'countdown': count_time } return result def speak_counting(self, counting_times, name): self.speak_driver.start() self.speak_driver.speed_control(200) self.speak_driver.volume_control(1) self.speak_driver.add_speak("考试人员{}".format(name)) self.speak_driver.add_speak(f"考试项目{self.exercise_type}") def display(self, img): cv2.rectangle(img, (self.corner[2], self.corner[0]), (self.corner[3], self.corner[1]), (0, 255, 0), 2) cv2.rectangle(img, (self.corner[2], 165), (self.corner[3], 470), (0, 255, 0), 2) # 绘制状态条 cv2.rectangle(img, (650 - 100, 60), (650 - 80, 282), (255, 255, 255), 2) self.detector.drawPoint_more(img, [9, 11, 13, 19, 25], bias_x=self.corner[2], bias_y=self.corner[0]) self.detector.drawPoint_more(img, [10, 12, 14, 20, 26], bias_x=self.corner[2], bias_y=self.corner[0]) if self.bar and self.per: cv2.rectangle(img, (650 - 98, int(self.bar)), (650 - 82, 280), (102, 106, 233), cv2.FILLED) cv2.putText(img, f'{int(self.per)}%', (650 - 125, 320), cv2.FONT_HERSHEY_PLAIN, 2, (255, 255, 255), 2) # 绘制计数器 cv2.rectangle(img, (0, 480 - 120), (120, 480), (102, 106, 233), cv2.FILLED) cv2.putText(img, str(int(self.count)), (10, 480 - 35), cv2.FONT_HERSHEY_PLAIN, 5, (255, 255, 255), 5) # 展示状态反馈 cv2.rectangle(img, (640 - 160, 0), (640, 50), (102, 106, 233), cv2.FILLED) img_output = self.cv2_img_add_text(img, self.feedback, 640 - 120, 5, (255, 255, 255), 38) return img_output def analysis(self, frame): catch_time = frame[CATCH_TIME] if catch_time < self.start_cal_time: return img = frame[FRAME_DAT] lm_list = frame[MP_RESULT] self.detector.set_result(lm_list) if len(lm_list) != 0: elbow_1 = self.detector.findAngle(img, 11, 13, 15) shoulder_1 = self.detector.findAngle(img, 13, 11, 23) elbow_2 = self.detector.findAngle(img, 12, 14, 16) shoulder_2 = self.detector.findAngle(img, 14, 12, 24) shoulder_1_y = self.detector.findPosition(img, False)[11][2] shoulder_2_y = self.detector.findPosition(img, False)[12][2] shoulder_1_x = self.detector.findPosition(img, False)[11][1] shoulder_2_x = self.detector.findPosition(img, False)[12][1] eye_1_y = self.detector.findPosition(img, False)[3][2] eye_2_y = self.detector.findPosition(img, False)[6][2] mouth_1_y = self.detector.findPosition(img, False)[9][2] mouth_2_y = self.detector.findPosition(img, False)[10][2] wrist_1_y = self.detector.findPosition(img, False)[15][2] wrist_2_y = self.detector.findPosition(img, False)[16][2] index_1_y = self.detector.findPosition(img, False)[19][2] index_2_y = self.detector.findPosition(img, False)[20][2] hip_1_x = self.detector.findPosition(img, False)[23][1] hip_1_y = self.detector.findPosition(img, False)[23][2] hip_2_x = self.detector.findPosition(img, False)[24][1] hip_2_y = self.detector.findPosition(img, False)[24][2] hand_1_y = (wrist_1_y + index_1_y) / 2 hand_2_y = (wrist_2_y + index_2_y) / 2 head_1_y = (mouth_1_y + eye_1_y) / 2 head_2_y = (mouth_2_y + eye_2_y) / 2 h_range = mouth_1_y - hand_1_y # 成功概率 self.per = np.interp(h_range, (90, 0), (0, 100)) # 显示进度栏 self.bar = np.interp(h_range, (90, 0), (280, 62)) if self.pre_pos == 0: self.pre_pos = 1 self.speak_driver.add_speak("上杠，听到提示声后开始考试") if self.form == 0: if time.time() - self.sta_time > 1.5: if elbow_1 > 150 and elbow_2 > 150 and shoulder_1 > 100 and shoulder_2 > 100 and eye_1_y > wrist_1_y and eye_2_y > wrist_2_y: self.time_1 += 1 if self.time_1 > 30: self.form = 1 beep() self.starttime = time.time() self.initial_wrist_1_y = wrist_1_y self.initial_wrist_2_y = wrist_2_y # self.initial_height_left = math.sqrt( # math.pow(shoulder_2_x - hip_2_x, 2) + math.pow(shoulder_2_y - hip_2_y, 2)) * math.cos( # math.pi / 5) # self.initial_height_right = math.sqrt( # math.pow(shoulder_1_x - hip_1_x, 2) + math.pow(shoulder_1_y - hip_1_y, 2)) * math.cos( # math.pi / 5) elif self.pre_pos == 1 and self.form == 1: # height_left = math.sqrt(math.pow(shoulder_2_x - hip_2_x, 2) + math.pow(shoulder_2_y - hip_2_y, 2)) # height_right = math.sqrt(math.pow(shoulder_1_x - hip_1_x, 2) + math.pow(shoulder_1_y - hip_1_y, 2)) if wrist_1_y - self.initial_wrist_1_y > 50 and wrist_2_y - self.initial_wrist_2_y > 50 and self.pre_pos == 1: self.end_test += 1 if self.end_test > 2: self.speak_driver.add_speak("双手已离开单杠，考试结束") self.pre_pos = 2 self.had_done = True # if height_left < self.initial_height_left and height_right < self.initial_height_right: # self.t += 1 # if self.t > 4: # self.state = 1 # self.t = 0 # if self.body_state == 0: # self.speak_driver.add_speak('摆幅过大') # self.body_state = 1 if elbow_1 > 150 and elbow_2 > 150 and head_1_y > hand_1_y and head_2_y > hand_2_y: self.feedback = "上升" self.state = 0 if self.direction == 0: self._time += 1 if self._time > 3: self.count += 0.5 self.direction = 1 self._time = 0 self.body_state = 0 if head_1_y < hand_1_y or head_2_y < hand_2_y and not self.had_done: self.feedback = "下落" if self.state == 0: if self.direction == 1: self._time += 1 if self._time > 2: self.t = 0 self.count += 0.5 self.direction = 0 self._time = 0 if self.count % 1 == 0: self.speak_driver.speed_control(320) self.speak_driver.add_speak("{}".format(int(self.count))) if self.count == 1: self.initial_wrist_1_y = wrist_1_y self.initial_wrist_2_y = wrist_2_y # if h_range < 20 and self.is_storard == 1: # self.time += 1 # if self.time > 3: # self.is_storard = 2 # self.time = 0 # elif head_1_y < hand_1_y and head_2_y < hand_2_y and self.is_storard == 2: # self.time += 1 # if self.time > 3: # self.is_storard = 3 # self.time = 0 # elif h_range > 30 and self.is_storard == 2: # self.time += 1 # if self.time > 3: # self.is_storard = 1 # self.speak_driver.add_speak('未过杠') # self.time = 0 # elif h_range > 30 and self.is_storard == 3: # self.time += 1 # if self.time > 3: # self.is_storard = 1 # self.time = 0