sem/5g_drone_ROS2
1
0
Fork 0
Code Issues 1 Pull Requests 1 Actions Packages Projects Releases Wiki Activity

make camera controller exit on many errors

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-06-05 21:23:05 +02:00
parent 096cee40be
commit 8b2dfd27e2
1 changed files with 7 additions and 1 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
src/camera/camera/camera_controller.py
View File

@@ -9,7 +9,7 @@ import asyncio
import websockets.server import websockets.server
import threading import threading
import cv2 import cv2
import sys
import requests import requests
#resolution of the camera #resolution of the camera
@@ -74,6 +74,7 @@ class CameraController(Node):
vid.set(cv2.CAP_PROP_FRAME_WIDTH, 1920) vid.set(cv2.CAP_PROP_FRAME_WIDTH, 1920)
vid.set(cv2.CAP_PROP_FRAME_HEIGHT, 1080) vid.set(cv2.CAP_PROP_FRAME_HEIGHT, 1080)
error_amount = 0
while True: while True:
try: try:
while(vid.isOpened()): while(vid.isOpened()):
@@ -86,8 +87,13 @@ class CameraController(Node):
#sender(man) #sender(man)
await websocket.send(man.tobytes()) await websocket.send(man.tobytes())
self.get_logger().error("Not opened") self.get_logger().error("Not opened")
error_amount += 1
except Exception as e: except Exception as e:
self.get_logger().error("error " + str(e)) self.get_logger().error("error " + str(e))
error_amount += 1
if error_amount > 20:
self.get_logger().error("Too many errors, closing node")
sys.exit(-1)
def handle_video_connection(self): def handle_video_connection(self):