diff --git a/src/gesture_controll_drone/camera_utils.py b/src/gesture_controll_drone/camera_utils.py new file mode 100644 index 0000000000..e765a5f690 --- /dev/null +++ b/src/gesture_controll_drone/camera_utils.py @@ -0,0 +1,44 @@ +import cv2 + +class Camera: + """摄像头工具类""" + + def __init__(self, camera_index=0): + self.camera_index = camera_index + self.cap = None + + def initialize(self): + """初始化摄像头""" + self.cap = cv2.VideoCapture(self.camera_index) + if not self.cap.isOpened(): + # 尝试其他摄像头索引 + for i in range(1, 5): + self.cap = cv2.VideoCapture(i) + if self.cap.isOpened(): + self.camera_index = i + break + else: + raise Exception("无法找到可用的摄像头") + + # 设置摄像头参数 + self.cap.set(cv2.CAP_PROP_FRAME_WIDTH, 640) + self.cap.set(cv2.CAP_PROP_FRAME_HEIGHT, 480) + return True + + def read_frame(self): + """读取一帧""" + if self.cap is None: + raise Exception("摄像头未初始化") + + ret, frame = self.cap.read() + if not ret: + raise Exception("无法读取摄像头帧") + + # 水平翻转帧 + frame = cv2.flip(frame, 1) + return frame + + def release(self): + """释放摄像头资源""" + if self.cap: + self.cap.release()