diff --git a/src/gesture_controll_drone/main.py b/src/gesture_controll_drone/main.py index ad1a8a770b..63c2ade13d 100644 --- a/src/gesture_controll_drone/main.py +++ b/src/gesture_controll_drone/main.py @@ -10,46 +10,53 @@ class VirtualDrone: """ 虚拟无人机模拟器类 负责创建无人机可视化界面、管理无人机状态、执行控制命令 - - 属性: - width/height: 窗口尺寸 - screen: pygame显示窗口 - position: 无人机2D坐标 [x, y] - altitude: 无人机高度(m) - battery: 电池电量(%) - is_flying: 飞行状态标识 - speed: 移动速度 - 各类颜色/字体配置 """ + # 窗口配置常量 + WINDOW_WIDTH = 400 + WINDOW_HEIGHT = 300 + + # 无人机初始状态常量 + INIT_POSITION = [200, 150] + INIT_ALTITUDE = 0 + INIT_BATTERY = 100 + SPEED = 3 + # 颜色常量 + BG_COLOR = (30, 30, 50) + GROUND_COLOR = (50, 50, 70) + DRONE_COLOR_FLYING = (0, 255, 0) + DRONE_COLOR_GROUND = (255, 100, 100) + PROPELLER_COLOR = (200, 200, 200) + TEXT_COLOR = (255, 255, 255) + + # 渲染常量 + DRONE_RADIUS = 15 + PROPELLER_RADIUS = 6 + GROUND_HEIGHT = 100 + BATTERY_CONSUMPTION_RATE = 0.05 + def __init__(self): """初始化pygame环境和无人机初始状态""" - pygame.init() + try: + pygame.init() + except pygame.error as e: + print(f"Pygame初始化失败: {e}") + raise # 窗口配置 - self.width, self.height = 400, 300 - self.screen = pygame.display.set_mode((self.width, self.height)) + self.screen = pygame.display.set_mode((self.WINDOW_WIDTH, self.WINDOW_HEIGHT)) pygame.display.set_caption("虚拟无人机模拟器") # 无人机初始状态 - self.position = [200, 150] # 初始位置居中 - self.altitude = 0 # 初始高度为0(地面) - self.battery = 100 # 初始电量100% - self.is_flying = False # 初始未飞行 - self.speed = 3 # 移动速度 + self.position = self.INIT_POSITION.copy() + self.altitude = self.INIT_ALTITUDE + self.battery = self.INIT_BATTERY + self.is_flying = False # 视觉样式配置 - self._init_visual_config() + self.font = pygame.font.Font(None, 24) - print("虚拟无人机模拟器已启动") - - def _init_visual_config(self): - """初始化颜色和字体配置(提取独立函数)""" - self.bg_color = (30, 30, 50) - self.drone_color_flying = (0, 255, 0) # 飞行中绿色 - self.drone_color_ground = (255, 100, 100) # 地面红色 - self.text_color = (255, 255, 255) # 白色文字 - self.font = pygame.font.Font(None, 24) # 默认字体,24号大小 + print("✅ 虚拟无人机模拟器已启动") def execute_command(self, command): """ @@ -63,72 +70,82 @@ def execute_command(self, command): """ result = False - # 命令执行逻辑(功能完全不变) - if command == "起飞" and not self.is_flying: - self.is_flying = True - self.altitude = 10 - print("🛫 无人机起飞") - result = True + try: + # 命令执行逻辑 + if command == "起飞" and not self.is_flying: + self.is_flying = True + self.altitude = 10 + print("🛫 无人机起飞") + result = True + + elif command == "降落" and self.is_flying: + self.is_flying = False + self.altitude = 0 + print("🛬 无人机降落") + result = True + + elif command == "前进" and self.is_flying: + self.position[1] = max(50, self.position[1] - self.SPEED) + self.altitude = min(50, self.altitude + 0.5) + print("➡️ 无人机前进") + result = True + + elif command == "上升" and self.is_flying: + self.altitude = min(100, self.altitude + 10) + print(f"⬆️ 无人机上升 | 当前高度: {self.altitude}m") + result = True + + elif command == "紧急停止": + self.is_flying = False + self.altitude = 0 + print("🚨 紧急停止!") + result = True + + # 模拟电池消耗(仅飞行时消耗) + if self.is_flying: + self.battery = max(0, self.battery - self.BATTERY_CONSUMPTION_RATE) + + except Exception as e: + print(f"❌ 执行命令 '{command}' 时出错: {e}") + result = False - elif command == "降落" and self.is_flying: - self.is_flying = False - self.altitude = 0 - print("🛬 无人机降落") - result = True + return result + + def draw(self): + """绘制无人机界面和状态信息(视觉渲染主函数)""" + try: + # 清屏 + self.screen.fill(self.BG_COLOR) - elif command == "前进" and self.is_flying: - self.position[1] = max(50, self.position[1] - self.speed) - self.altitude = min(50, self.altitude + 0.5) - print("➡️ 无人机前进") - result = True + # 绘制地面 + pygame.draw.rect( + self.screen, + self.GROUND_COLOR, + (0, self.WINDOW_HEIGHT - self.GROUND_HEIGHT, self.WINDOW_WIDTH, self.GROUND_HEIGHT) + ) - elif command == "上升" and self.is_flying: - self.altitude = min(100, self.altitude + 10) - print(f"⬆️ 无人机上升 | 当前高度: {self.altitude}m") - result = True + # 绘制无人机(根据飞行状态切换颜色) + drone_color = self.DRONE_COLOR_FLYING if self.is_flying else self.DRONE_COLOR_GROUND + drone_y = self.WINDOW_HEIGHT - 120 - self.altitude * 2 - elif command == "紧急停止": - self.is_flying = False - self.altitude = 0 - print("🚨 紧急停止!") - result = True + # 绘制无人机主体(圆形) + pygame.draw.circle(self.screen, drone_color, (self.position[0], drone_y), self.DRONE_RADIUS) - # 模拟电池消耗(仅飞行时消耗) - if self.is_flying: - self.battery = max(0, self.battery - 0.05) + # 绘制无人机螺旋桨(四个小圆形) + self._draw_drone_propellers(drone_y) - return result - - def draw(self): - """绘制无人机界面和状态信息(视觉渲染主函数)""" - # 清屏 - self.screen.fill(self.bg_color) - - # 绘制地面 - pygame.draw.rect(self.screen, (50, 50, 70), (0, self.height - 100, self.width, 100)) - - # 绘制无人机(根据飞行状态切换颜色) - drone_color = self.drone_color_flying if self.is_flying else self.drone_color_ground - drone_y = self.height - 120 - self.altitude * 2 - - # 绘制无人机主体(圆形) - pygame.draw.circle(self.screen, drone_color, (self.position[0], drone_y), 15) - - # 绘制无人机螺旋桨(四个小圆形) - self._draw_drone_propellers(drone_y) - - # 绘制状态信息和控制说明 - self._draw_status_info() - self._draw_control_instructions() - - # 更新显示 - pygame.display.flip() + # 绘制状态信息和控制说明 + self._draw_status_info() + self._draw_control_instructions() + + # 更新显示 + pygame.display.flip() + + except Exception as e: + print(f"❌ 绘制界面时出错: {e}") def _draw_drone_propellers(self, drone_y): - """绘制无人机螺旋桨(提取独立函数)""" - propeller_color = (200, 200, 200) # 螺旋桨颜色 - propeller_radius = 6 # 螺旋桨半径 - + """绘制无人机螺旋桨""" # 四个螺旋桨位置 prop_positions = [ (self.position[0] - 20, drone_y - 12), @@ -138,10 +155,10 @@ def _draw_drone_propellers(self, drone_y): ] for pos in prop_positions: - pygame.draw.circle(self.screen, propeller_color, pos, propeller_radius) + pygame.draw.circle(self.screen, self.PROPELLER_COLOR, pos, self.PROPELLER_RADIUS) def _draw_status_info(self): - """绘制无人机状态信息(提取独立函数)""" + """绘制无人机状态信息""" status = "飞行中" if self.is_flying else "在地面" texts = [ f"状态: {status}", @@ -152,11 +169,11 @@ def _draw_status_info(self): # 逐行绘制状态文本 for i, text in enumerate(texts): - text_surface = self.font.render(text, True, self.text_color) + text_surface = self.font.render(text, True, self.TEXT_COLOR) self.screen.blit(text_surface, (10, 10 + i * 25)) def _draw_control_instructions(self): - """绘制控制说明文本(提取独立函数)""" + """绘制控制说明文本""" controls = [ "控制说明:", "张开手掌 - 起飞", @@ -168,40 +185,61 @@ def _draw_control_instructions(self): # 逐行绘制控制说明 for i, control in enumerate(controls): - text_surface = self.font.render(control, True, self.text_color) - self.screen.blit(text_surface, (self.width - 200, 10 + i * 25)) + text_surface = self.font.render(control, True, self.TEXT_COLOR) + self.screen.blit(text_surface, (self.WINDOW_WIDTH - 200, 10 + i * 25)) def process_events(self): """处理pygame窗口事件(如关闭窗口)""" - for event in pygame.event.get(): - if event.type == QUIT: - return False - return True + try: + for event in pygame.event.get(): + if event.type == QUIT: + return False + return True + except Exception as e: + print(f"❌ 处理窗口事件时出错: {e}") + return False class GestureRecognizer: """ 手势识别器类 基于MediaPipe实现手部关键点检测,识别预设手势并转换为控制命令 - - 属性: - mp_hands: MediaPipe手部检测模块 - hands: 手部检测处理器 - mp_drawing: 关键点绘制工具 - cap: 摄像头捕获对象 """ + # 摄像头配置常量 + CAMERA_WIDTH = 640 + CAMERA_HEIGHT = 480 + CAMERA_INDICES_TO_TRY = [0, 1, 2, 3, 4] + + # 手势检测常量 + HAND_DETECTION_CONFIDENCE = 0.6 + HAND_TRACKING_CONFIDENCE = 0.5 + MAX_HANDS = 1 + OK_GESTURE_DISTANCE_THRESHOLD = 30 + FINGER_BENT_THRESHOLD = 20 + + # 关键点索引常量 + THUMB_TIP = 4 + INDEX_FINGER_TIP = 8 + MIDDLE_FINGER_TIP = 12 + RING_FINGER_TIP = 16 + PINKY_TIP = 20 def __init__(self): """初始化MediaPipe手部检测和摄像头""" self.mp_hands = mp.solutions.hands - # 配置手部检测参数(优化参数命名,语义不变) - self.hands = self.mp_hands.Hands( - static_image_mode=False, # 视频流模式 - max_num_hands=1, # 仅检测单只手 - min_detection_confidence=0.6, # 检测置信度阈值 - min_tracking_confidence=0.5 # 跟踪置信度阈值 - ) self.mp_drawing = mp.solutions.drawing_utils - self.cap = None # 摄像头对象初始化为None + self.cap = None + + # 初始化手部检测器 + try: + self.hands = self.mp_hands.Hands( + static_image_mode=False, + max_num_hands=self.MAX_HANDS, + min_detection_confidence=self.HAND_DETECTION_CONFIDENCE, + min_tracking_confidence=self.HAND_TRACKING_CONFIDENCE + ) + except Exception as e: + print(f"❌ MediaPipe手部检测器初始化失败: {e}") + raise def initialize_camera(self): """ @@ -210,24 +248,23 @@ def initialize_camera(self): 返回: bool: 摄像头初始化是否成功 """ - print("初始化摄像头...") - self.cap = cv2.VideoCapture(0) + print("🔍 初始化摄像头...") - # 如果索引0失败,尝试1-4索引 - if not self.cap.isOpened(): - for cam_index in range(1, 5): + for cam_index in self.CAMERA_INDICES_TO_TRY: + try: self.cap = cv2.VideoCapture(cam_index) if self.cap.isOpened(): - print(f"找到摄像头在索引 {cam_index}") - break - else: - raise Exception("无法找到可用的摄像头") - - # 设置摄像头分辨率 - self.cap.set(cv2.CAP_PROP_FRAME_WIDTH, 640) - self.cap.set(cv2.CAP_PROP_FRAME_HEIGHT, 480) - print("摄像头初始化成功") - return True + # 设置摄像头分辨率 + self.cap.set(cv2.CAP_PROP_FRAME_WIDTH, self.CAMERA_WIDTH) + self.cap.set(cv2.CAP_PROP_FRAME_HEIGHT, self.CAMERA_HEIGHT) + print(f"✅ 找到摄像头在索引 {cam_index}") + print("✅ 摄像头初始化成功") + return True + except Exception as e: + print(f"⚠️ 摄像头索引 {cam_index} 初始化失败: {e}") + continue + + raise Exception("❌ 无法找到可用的摄像头") def detect_gesture(self, frame): """ @@ -241,76 +278,52 @@ def detect_gesture(self, frame): gesture: 识别到的手势名称 command: 对应的控制命令 """ - # 转换颜色空间(BGR -> RGB) - rgb_frame = cv2.cvtColor(frame, cv2.COLOR_BGR2RGB) - results = self.hands.process(rgb_frame) - gesture = "未检测到手势" command = "等待" - # 如果检测到手部关键点 - if results.multi_hand_landmarks: - for hand_landmarks in results.multi_hand_landmarks: - # 绘制手部关键点和连接线 - self.mp_drawing.draw_landmarks( - frame, hand_landmarks, self.mp_hands.HAND_CONNECTIONS) - - # 提取关键点坐标 - landmarks = self._extract_landmarks(hand_landmarks, frame.shape) - - # 识别手势并转换为命令 - gesture = self._improved_classify_gesture(landmarks) - command = self._gesture_to_command(gesture) + try: + # 转换颜色空间(BGR -> RGB) + rgb_frame = cv2.cvtColor(frame, cv2.COLOR_BGR2RGB) + results = self.hands.process(rgb_frame) + + # 如果检测到手部关键点 + if results.multi_hand_landmarks: + for hand_landmarks in results.multi_hand_landmarks: + # 绘制手部关键点和连接线 + self.mp_drawing.draw_landmarks( + frame, hand_landmarks, self.mp_hands.HAND_CONNECTIONS) + + # 提取关键点坐标 + landmarks = self._extract_landmarks(hand_landmarks, frame.shape) + + # 识别手势并转换为命令 + gesture = self._improved_classify_gesture(landmarks) + command = self._gesture_to_command(gesture) + + except Exception as e: + print(f"❌ 手势检测时出错: {e}") return frame, gesture, command def _extract_landmarks(self, hand_landmarks, frame_shape): - """ - 提取手部关键点的像素坐标 - - 参数: - hand_landmarks: MediaPipe手部关键点对象 - frame_shape: 视频帧形状 (h, w, c) - - 返回: - list: 关键点像素坐标列表 [(x1,y1), (x2,y2), ...] - """ + """提取手部关键点的像素坐标""" h, w, _ = frame_shape landmarks = [] for lm in hand_landmarks.landmark: - # 将归一化坐标转换为像素坐标 px = int(lm.x * w) py = int(lm.y * h) landmarks.append((px, py)) return landmarks def _improved_classify_gesture(self, landmarks): - """ - 改进的手势分类算法(支持OK手势检测) - - 参数: - landmarks: 手部关键点像素坐标列表 - - 返回: - str: 识别到的手势名称 - """ + """改进的手势分类算法(支持OK手势检测)""" # 校验关键点数量 if not landmarks or len(landmarks) < 21: return "未检测到手势" - # 定义关键点索引常量(提高可读性) - THUMB_TIP = 4 # 拇指指尖 - INDEX_FINGER_TIP = 8 # 食指指尖 - MIDDLE_FINGER_TIP = 12 # 中指指尖 - RING_FINGER_TIP = 16 # 无名指指尖 - PINKY_TIP = 20 # 小指指尖 - # 获取关键点位坐标 - thumb_tip = landmarks[THUMB_TIP] - index_tip = landmarks[INDEX_FINGER_TIP] - middle_tip = landmarks[MIDDLE_FINGER_TIP] - ring_tip = landmarks[RING_FINGER_TIP] - pinky_tip = landmarks[PINKY_TIP] + thumb_tip = landmarks[self.THUMB_TIP] + index_tip = landmarks[self.INDEX_FINGER_TIP] # 检测各手指是否伸直 fingers = self._detect_extended_fingers(landmarks) @@ -320,7 +333,7 @@ def _improved_classify_gesture(self, landmarks): # 检测OK手势(拇指和食指接触,其他手指弯曲) thumb_index_dist = np.sqrt((thumb_tip[0]-index_tip[0])**2 + (thumb_tip[1]-index_tip[1])**2) - if thumb_index_dist < 30 and extended_fingers <= 3: + if thumb_index_dist < self.OK_GESTURE_DISTANCE_THRESHOLD and extended_fingers <= 3: # 检查中指、无名指、小指是否弯曲 other_fingers_bent = self._check_other_fingers_bent(landmarks) if other_fingers_bent: @@ -339,23 +352,15 @@ def _improved_classify_gesture(self, landmarks): return "其他手势" def _detect_extended_fingers(self, landmarks): - """ - 检测每根手指是否伸直 - - 参数: - landmarks: 手部关键点坐标列表 - - 返回: - list: 手指伸直状态 [拇指, 食指, 中指, 无名指, 小指] - """ + """检测每根手指是否伸直""" fingers = [] # 拇指:比较指尖和IP关节的x坐标 - fingers.append(landmarks[4][0] < landmarks[3][0]) + fingers.append(landmarks[self.THUMB_TIP][0] < landmarks[self.THUMB_TIP-1][0]) # 其他手指:比较指尖和PIP关节的y坐标 - finger_tips = [8, 12, 16, 20] - finger_pips = [6, 10, 14, 18] + finger_tips = [self.INDEX_FINGER_TIP, self.MIDDLE_FINGER_TIP, self.RING_FINGER_TIP, self.PINKY_TIP] + finger_pips = [self.INDEX_FINGER_TIP-2, self.MIDDLE_FINGER_TIP-2, self.RING_FINGER_TIP-2, self.PINKY_TIP-2] for tip, pip in zip(finger_tips, finger_pips): fingers.append(landmarks[tip][1] < landmarks[pip][1]) @@ -364,25 +369,17 @@ def _detect_extended_fingers(self, landmarks): def _check_other_fingers_bent(self, landmarks): """检查中指、无名指、小指是否弯曲(OK手势辅助检测)""" - finger_tips = [12, 16, 20] - finger_pips = [10, 14, 18] + finger_tips = [self.MIDDLE_FINGER_TIP, self.RING_FINGER_TIP, self.PINKY_TIP] + finger_pips = [self.MIDDLE_FINGER_TIP-2, self.RING_FINGER_TIP-2, self.PINKY_TIP-2] for tip, pip in zip(finger_tips, finger_pips): - # 如果手指伸直超过20像素,判定为未弯曲 - if landmarks[tip][1] < landmarks[pip][1] - 20: + # 如果手指伸直超过阈值,判定为未弯曲 + if landmarks[tip][1] < landmarks[pip][1] - self.FINGER_BENT_THRESHOLD: return False return True def _gesture_to_command(self, gesture): - """ - 将识别到的手势映射为无人机控制命令 - - 参数: - gesture: 手势名称 - - 返回: - str: 控制命令 - """ + """将识别到的手势映射为无人机控制命令""" command_map = { "张开手掌": "起飞", "握拳": "降落", @@ -395,52 +392,60 @@ def _gesture_to_command(self, gesture): return command_map.get(gesture, "等待") def release_camera(self): - """释放摄像头资源""" - if self.cap: - self.cap.release() + """释放摄像头资源(容错处理)""" + try: + if self.cap and self.cap.isOpened(): + self.cap.release() + print("✅ 摄像头资源已释放") + except Exception as e: + print(f"⚠️ 释放摄像头时出错: {e}") class GestureDroneSystem: """ 手势控制无人机主系统类 整合手势识别和无人机模拟器,提供完整的交互流程 """ + # 系统配置常量 + COMMAND_INTERVAL = 1.0 # 命令执行最小间隔(秒) + EXIT_KEY = ord('q') # 退出程序按键 def __init__(self): """初始化手势识别器和无人机模拟器""" self.gesture_recognizer = GestureRecognizer() self.drone_simulator = VirtualDrone() - self.is_running = False # 系统运行状态 + self.is_running = False def initialize(self): - """ - 初始化整个系统 - - 返回: - bool: 初始化是否成功 - """ + """初始化整个系统""" print("=" * 50) - print("手势控制无人机系统") + print("🤖 手势控制无人机系统") print("=" * 50) - # 初始化摄像头 - if not self.gesture_recognizer.initialize_camera(): - return False + try: + # 初始化摄像头 + if not self.gesture_recognizer.initialize_camera(): + return False + + # 打印使用说明 + self._print_usage_instructions() - # 打印使用说明 - self._print_usage_instructions() - - return True + return True + + except Exception as e: + print(f"❌ 系统初始化失败: {e}") + self.cleanup() + return False def _print_usage_instructions(self): - """打印系统使用说明(提取独立函数)""" - print("\n系统初始化完成!") - print("\n手势控制说明:") + """打印系统使用说明""" + print("\n✅ 系统初始化完成!") + print("\n📋 手势控制说明:") print("✋ 张开手掌 - 起飞") print("✊ 握拳 - 降落") print("👆 食指指向 - 前进") print("✌️ 胜利手势 - 上升") print("👌 OK手势 - 紧急停止") - print("\n按 'q' 键退出程序") + print(f"\n⌨️ 按 '{chr(self.EXIT_KEY)}' 键退出程序") print("=" * 50) def run(self): @@ -449,13 +454,12 @@ def run(self): return self.is_running = True - print("开始手势控制...") + print("▶️ 开始手势控制...") # 性能统计变量 frame_count = 0 start_time = time.time() last_command_time = 0 - command_interval = 1.0 # 命令执行间隔(防止重复执行) try: while self.is_running: @@ -466,8 +470,9 @@ def run(self): # 读取摄像头帧 ret, frame = self.gesture_recognizer.cap.read() if not ret: - print("无法读取摄像头帧") - break + print("⚠️ 无法读取摄像头帧,重试中...") + time.sleep(0.1) + continue # 帧计数+1,水平翻转帧(镜像显示) frame_count += 1 @@ -478,25 +483,28 @@ def run(self): # 执行控制命令(带时间间隔限制) current_time = time.time() - if (current_time - last_command_time > command_interval and + if (current_time - last_command_time > self.COMMAND_INTERVAL and command != "等待"): if self.drone_simulator.execute_command(command): print(f"✅ 执行命令: {command}") last_command_time = current_time elif command != "等待": - print(f"⏳ 识别到: {gesture} -> {command}") + print(f"⏳ 识别到: {gesture} -> {command} (冷却中)") # 显示帧信息、更新无人机界面 self._display_info(processed_frame, gesture, command, frame_count, start_time) - cv2.imshow('手势识别摄像头', processed_frame) + cv2.imshow('📷 手势识别摄像头', processed_frame) self.drone_simulator.draw() # 检测退出按键 - if cv2.waitKey(1) & 0xFF == ord('q'): + if cv2.waitKey(1) & 0xFF == self.EXIT_KEY: + print("\n🛑 用户请求退出程序") break + except KeyboardInterrupt: + print("\n🛑 用户中断程序执行") except Exception as e: - print(f"运行时错误: {e}") + print(f"❌ 系统运行时错误: {e}") finally: self.cleanup() @@ -509,18 +517,19 @@ def _display_info(self, frame, gesture, command, frame_count, start_time): elapsed_time = time.time() - start_time fps = frame_count / elapsed_time if elapsed_time > 0 else 0 - # 绘制文本信息(优化坐标和样式) - cv2.putText(frame, f"手势: {gesture}", (10, 30), - cv2.FONT_HERSHEY_SIMPLEX, 0.7, (0, 255, 0), 2) - - cv2.putText(frame, f"命令: {command}", (10, 60), - cv2.FONT_HERSHEY_SIMPLEX, 0.7, (0, 255, 255), 2) - - cv2.putText(frame, f"FPS: {fps:.1f}", (10, 90), - cv2.FONT_HERSHEY_SIMPLEX, 0.6, (255, 255, 255), 2) + # 绘制文本信息 + info_texts = [ + (f"🤘 手势: {gesture}", (10, 30), (0, 255, 0), 0.7, 2), + (f"🎮 命令: {command}", (10, 60), (0, 255, 255), 0.7, 2), + (f"⚡ FPS: {fps:.1f}", (10, 90), (255, 255, 255), 0.6, 2), + (f"按 '{chr(self.EXIT_KEY)}' 退出", (10, 450), (255, 255, 255), 0.5, 1) + ] - cv2.putText(frame, "按 'q' 退出", (10, 450), - cv2.FONT_HERSHEY_SIMPLEX, 0.5, (255, 255, 255), 1) + for text, pos, color, scale, thickness in info_texts: + cv2.putText( + frame, text, pos, + cv2.FONT_HERSHEY_SIMPLEX, scale, color, thickness + ) def _show_performance_stats(self, start_time, frame_count): """显示系统性能统计信息""" @@ -528,22 +537,42 @@ def _show_performance_stats(self, start_time, frame_count): avg_fps = frame_count / total_time if total_time > 0 else 0 print("\n" + "=" * 50) - print("性能统计") + print("📊 性能统计") print("=" * 50) - print(f"总运行时间: {total_time:.2f} 秒") - print(f"处理帧数: {frame_count}") - print(f"平均FPS: {avg_fps:.2f}") + print(f"⏱️ 总运行时间: {total_time:.2f} 秒") + print(f"🖼️ 处理帧数: {frame_count}") + print(f"⚡ 平均FPS: {avg_fps:.2f}") print("=" * 50) def cleanup(self): """清理系统资源(摄像头、窗口、pygame)""" self.is_running = False - self.gesture_recognizer.release_camera() - cv2.destroyAllWindows() - pygame.quit() - print("系统已关闭") + print("\n🧹 正在清理系统资源...") + + try: + self.gesture_recognizer.release_camera() + except Exception as e: + print(f"⚠️ 释放摄像头资源时出错: {e}") + + try: + cv2.destroyAllWindows() + print("✅ OpenCV窗口已关闭") + except Exception as e: + print(f"⚠️ 关闭OpenCV窗口时出错: {e}") + + try: + pygame.quit() + print("✅ Pygame资源已释放") + except Exception as e: + print(f"⚠️ 退出Pygame时出错: {e}") + + print("✅ 系统已安全关闭") if __name__ == "__main__": # 创建并运行系统 - drone_system = GestureDroneSystem() - drone_system.run() + try: + drone_system = GestureDroneSystem() + drone_system.run() + except Exception as e: + print(f"❌ 程序执行失败: {e}") + sys.exit(1)