Added ability to reopen the same camera multiple times.

This commit is contained in:
Josh Miklos
2022-10-07 19:33:50 -07:00
parent 64fe1e2094
commit 700bda2c56
3 changed files with 15 additions and 4 deletions

View File

@ -147,7 +147,6 @@ def pub_cam_loop_opencv(
sub = subscriber_dictionary.cam_cmd_sub(name) sub = subscriber_dictionary.cam_cmd_sub(name)
sub.return_on_no_data = "" sub.return_on_no_data = ""
msg = "" msg = ""
if mjpg: if mjpg:
try: try:
cam.set(cv2.CAP_PROP_FOURCC, cv2.CAP_OPENCV_MJPEG) cam.set(cv2.CAP_PROP_FOURCC, cv2.CAP_OPENCV_MJPEG)
@ -158,6 +157,7 @@ def pub_cam_loop_opencv(
cam.set(cv2.CAP_PROP_FRAME_HEIGHT, request_size[1]) cam.set(cv2.CAP_PROP_FRAME_HEIGHT, request_size[1])
if not cam.isOpened(): if not cam.isOpened():
print("camera failed to open")
subscriber_dictionary.CV_CAMS_DICT[name].status_pub.publish("failed") subscriber_dictionary.CV_CAMS_DICT[name].status_pub.publish("failed")
return False return False
now = time.time() now = time.time()
@ -168,13 +168,18 @@ def pub_cam_loop_opencv(
if ret is False or not isinstance(frame, (np.ndarray, list)): if ret is False or not isinstance(frame, (np.ndarray, list)):
cam.release() cam.release()
subscriber_dictionary.CV_CAMS_DICT[name].status_pub.publish("failed") subscriber_dictionary.CV_CAMS_DICT[name].status_pub.publish("failed")
print("cam returned false")
return False return False
if cam.get(cv2.CAP_PROP_FRAME_COUNT) > 0: if cam.get(cv2.CAP_PROP_FRAME_COUNT) > 0:
frame_counter += 1 frame_counter += 1
if frame_counter >= cam.get(cv2.CAP_PROP_FRAME_COUNT): if frame_counter >= cam.get(cv2.CAP_PROP_FRAME_COUNT):
frame_counter = 0 frame_counter = 0
cam = cv2.VideoCapture(cam_id) cam = cv2.VideoCapture(cam_id)
subscriber_dictionary.CV_CAMS_DICT[name].frame_pub.publish(frame) try:
subscriber_dictionary.CV_CAMS_DICT[name].frame_pub.publish(frame)
except KeyError: # we got deleted. Time to exit.
cam.release()
return False
msg = sub.get() msg = sub.get()
sub.release() sub.release()
@ -195,9 +200,10 @@ def pub_cam_thread(
"""Run pub_cam_loop in a new thread. Starts on creation.""" """Run pub_cam_loop in a new thread. Starts on creation."""
name = uid_for_source(cam_id) name = uid_for_source(cam_id)
t = None
if name in uid_dict.keys(): if name in uid_dict.keys():
t = uid_dict[name] t = uid_dict[name]
else: if t is None or not t.is_alive(): # Enables reopening cameras
if "cv" in force_backend.lower(): if "cv" in force_backend.lower():
pub_cam_loop = pub_cam_loop_opencv pub_cam_loop = pub_cam_loop_opencv
elif ( elif (

View File

@ -50,6 +50,11 @@ def stop_cam(cam_id: Union[int, str]):
if str(cam_id) in CV_CAM_HANDLERS_DICT: if str(cam_id) in CV_CAM_HANDLERS_DICT:
CV_CAM_HANDLERS_DICT[str(cam_id)].cmd_pub.publish("quit", blocking=True) CV_CAM_HANDLERS_DICT[str(cam_id)].cmd_pub.publish("quit", blocking=True)
def del_cam(cam_id: Union[int, str]):
if str(cam_id) in CV_CAMS_DICT:
del CV_CAMS_DICT[str(cam_id)]
if str(cam_id) in CV_CAM_HANDLERS_DICT:
del CV_CAM_HANDLERS_DICT[str(cam_id)]
def cam_cmd_sub(cam_id, blocking=True): def cam_cmd_sub(cam_id, blocking=True):
"""Get a command subscriber for registered camera "cam_id".""" """Get a command subscriber for registered camera "cam_id"."""

View File

@ -112,6 +112,7 @@ class SubscriberWindows(object):
def __stop_all_cams(self): def __stop_all_cams(self):
for c in self.source_names: for c in self.source_names:
subscriber_dictionary.stop_cam(c) subscriber_dictionary.stop_cam(c)
subscriber_dictionary.del_cam(c)
def handle_keys(self, key_input: int): def handle_keys(self, key_input: int):
"""Capture key input for the escape function and passing to key control subscriber threads.""" """Capture key input for the escape function and passing to key control subscriber threads."""
@ -214,7 +215,6 @@ class SubscriberWindows(object):
def update_frames(self): def update_frames(self):
"""Update the windows with the newest data for all frames.""" """Update the windows with the newest data for all frames."""
self.frames = {} self.frames = {}
for i in range(len(self.input_vid_global_names)): for i in range(len(self.input_vid_global_names)):
if self.input_vid_global_names[i] in self.FRAME_DICT and not isinstance( if self.input_vid_global_names[i] in self.FRAME_DICT and not isinstance(
self.FRAME_DICT[self.input_vid_global_names[i]], NoData self.FRAME_DICT[self.input_vid_global_names[i]], NoData