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

use opencv for image taking and writing

Browse Source
This commit is contained in:
Sem van der Hoeven
2023-05-08 17:08:34 +02:00
parent d9707d6157
commit 7d82c1f33a
1 changed files with 13 additions and 10 deletions
Download Patch File Download Diff File Expand all files Collapse all files

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

@@ -3,22 +3,25 @@ from rclpy.node import Node
from drone_services.srv import TakePicture from drone_services.srv import TakePicture
from picamera2 import Picamera2 from cv2 import *
class CameraController(Node): class CameraController(Node):
def __init__(self): def __init__(self):
super().__init__('camera_controller') super().__init__('camera_controller')
self.picam2 = Picamera2() self.cam = VideoCapture(0)
self.srv = self.create_service(TakePicture, 'drone/picture', self.take_picture_callback) self.srv = self.create_service(TakePicture, 'drone/picture', self.take_picture_callback)
def take_picture_callback(self, request, response): def take_picture_callback(self, request, response):
result, image = self.cam.read()
if (result):
if (request.input_name == "default"): if (request.input_name == "default"):
self.get_logger().info("Taking picture with default filename") self.get_logger().info("Taking picture with default filename")
self.picam2.start_and_capture_file("/home/ubuntu/image.jpg") imwrite("/home/ubuntu/image.jpg", image)
response.filename = "/home/ubuntu/image.jpg" response.filename = "/home/ubuntu/image.jpg"
else: else:
self.picam2.start_and_capture_file(request.input_name) imwrite(request.input_name, image)
response.filename = request.input_name response.filename = request.input_name
return response return response