summaryrefslogtreecommitdiff
path: root/src/v4l2/v4l2_camera_proxy.h
blob: f1a8b61c5eaca34453dcf9a5d40abf03a83d0646 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
/* SPDX-License-Identifier: LGPL-2.1-or-later */
/*
 * Copyright (C) 2019, Google Inc.
 *
 * v4l2_camera_proxy.h - Proxy to V4L2 compatibility camera
 */

#ifndef __V4L2_CAMERA_PROXY_H__
#define __V4L2_CAMERA_PROXY_H__

#include <linux/videodev2.h>
#include <map>
#include <memory>
#include <set>
#include <sys/types.h>
#include <vector>

#include <libcamera/camera.h>

#include "v4l2_camera.h"

using namespace libcamera;

class V4L2CameraFile;

class V4L2CameraProxy
{
public:
	V4L2CameraProxy(unsigned int index, std::shared_ptr<Camera> camera);

	int open(V4L2CameraFile *file);
	void close(V4L2CameraFile *file);
	void *mmap(void *addr, size_t length, int prot, int flags, off64_t offset);
	int munmap(void *addr, size_t length);

	int ioctl(V4L2CameraFile *file, unsigned long request, void *arg);

private:
	bool validateBufferType(uint32_t type);
	bool validateMemoryType(uint32_t memory);
	void setFmtFromConfig(const StreamConfiguration &streamConfig);
	void querycap(std::shared_ptr<Camera> camera);
	int tryFormat(struct v4l2_format *arg);
	enum v4l2_priority maxPriority();
	void updateBuffers();
	void freeBuffers();

	int vidioc_querycap(struct v4l2_capability *arg);
	int vidioc_enum_framesizes(V4L2CameraFile *file, struct v4l2_frmsizeenum *arg);
	int vidioc_enum_fmt(V4L2CameraFile *file, struct v4l2_fmtdesc *arg);
	int vidioc_g_fmt(V4L2CameraFile *file, struct v4l2_format *arg);
	int vidioc_s_fmt(V4L2CameraFile *file, struct v4l2_format *arg);
	int vidioc_try_fmt(V4L2CameraFile *file, struct v4l2_format *arg);
	int vidioc_g_priority(V4L2CameraFile *file, enum v4l2_priority *arg);
	int vidioc_s_priority(V4L2CameraFile *file, enum v4l2_priority *arg);
	int vidioc_enuminput(V4L2CameraFile *file, struct v4l2_input *arg);
	int vidioc_g_input(V4L2CameraFile *file, int *arg);
	int vidioc_s_input(V4L2CameraFile *file, int *arg);
	int vidioc_reqbufs(V4L2CameraFile *file, struct v4l2_requestbuffers *arg);
	int vidioc_querybuf(V4L2CameraFile *file, struct v4l2_buffer *arg);
	int vidioc_qbuf(V4L2CameraFile *file, struct v4l2_buffer *arg);
	int vidioc_dqbuf(V4L2CameraFile *file, struct v4l2_buffer *arg, MutexLocker *locker);
	int vidioc_streamon(V4L2CameraFile *file, int *arg);
	int vidioc_streamoff(V4L2CameraFile *file, int *arg);

	bool hasOwnership(V4L2CameraFile *file);
	int acquire(V4L2CameraFile *file);
	void release(V4L2CameraFile *file);

	static const std::set<unsigned long> supportedIoctls_;

	unsigned int refcount_;
	unsigned int index_;

	StreamConfiguration streamConfig_;
	unsigned int bufferCount_;
	unsigned int currentBuf_;
	unsigned int sizeimage_;

	struct v4l2_capability capabilities_;
	struct v4l2_pix_format v4l2PixFormat_;

	std::vector<struct v4l2_buffer> buffers_;
	std::map<void *, unsigned int> mmaps_;

	std::set<V4L2CameraFile *> files_;

	std::unique_ptr<V4L2Camera> vcam_;

	/*
	 * This is the exclusive owner of this V4L2CameraProxy instance.
	 * When there is no owner, anybody can call any ioctl before reqbufs.
	 * The first file to call reqbufs with count > 0 or s_fmt will become
	 * the owner, and when the owner calls reqbufs with count = 0 it will
	 * release ownership. Any buffer-related ioctl (except querybuf) or
	 * s_fmt that is called by a non-owner while there exists an owner
	 * will return -EBUSY.
	 */
	V4L2CameraFile *owner_;

	/* This mutex is to serialize access to the proxy. */
	Mutex proxyMutex_;
};

#endif /* __V4L2_CAMERA_PROXY_H__ */
class="hl opt">.acquire() self.assertZero(ret) ret = cam.release() self.assertZero(ret) def test_double_acquire(self): cm = libcam.CameraManager.singleton() cam = cm.get('platform/vimc.0 Sensor B') self.assertIsNotNone(cam) ret = cam.acquire() self.assertZero(ret) libcam.log_set_level('Camera', 'FATAL') ret = cam.acquire() self.assertEqual(ret, -errno.EBUSY) libcam.log_set_level('Camera', 'ERROR') ret = cam.release() self.assertZero(ret) ret = cam.release() # I expected EBUSY, but looks like double release works fine self.assertZero(ret) class CameraTesterBase(BaseTestCase): cm: typing.Any cam: typing.Any def setUp(self): self.cm = libcam.CameraManager.singleton() self.cam = next((cam for cam in self.cm.cameras if 'platform/vimc' in cam.id), None) if self.cam is None: self.cm = None self.skipTest('No vimc found') ret = self.cam.acquire() if ret != 0: self.cam = None self.cm = None raise Exception('Failed to acquire camera') self.wr_cam = weakref.ref(self.cam) self.wr_cm = weakref.ref(self.cm) def tearDown(self): # If a test fails, the camera may be in running state. So always stop. self.cam.stop() ret = self.cam.release() if ret != 0: raise Exception('Failed to release camera') self.cam = None self.cm = None self.assertIsNone(self.wr_cm()) self.assertIsNone(self.wr_cam()) class AllocatorTestMethods(CameraTesterBase): def test_allocator(self): cam = self.cam camconfig = cam.generate_configuration([libcam.StreamRole.StillCapture]) self.assertTrue(camconfig.size == 1) wr_camconfig = weakref.ref(camconfig) streamconfig = camconfig.at(0) wr_streamconfig = weakref.ref(streamconfig) ret = cam.configure(camconfig) self.assertZero(ret) stream = streamconfig.stream wr_stream = weakref.ref(stream) # stream should keep streamconfig and camconfig alive streamconfig = None camconfig = None gc.collect() self.assertIsNotNone(wr_camconfig()) self.assertIsNotNone(wr_streamconfig()) allocator = libcam.FrameBufferAllocator(cam) ret = allocator.allocate(stream) self.assertTrue(ret > 0) wr_allocator = weakref.ref(allocator) buffers = allocator.buffers(stream) self.assertIsNotNone(buffers) buffers = None buffer = allocator.buffers(stream)[0] self.assertIsNotNone(buffer) wr_buffer = weakref.ref(buffer) allocator = None gc.collect() self.assertIsNotNone(wr_buffer()) self.assertIsNotNone(wr_allocator()) self.assertIsNotNone(wr_stream()) buffer = None gc.collect() self.assertIsNone(wr_buffer()) self.assertIsNone(wr_allocator()) self.assertIsNotNone(wr_stream()) stream = None gc.collect() self.assertIsNone(wr_stream()) self.assertIsNone(wr_camconfig()) self.assertIsNone(wr_streamconfig()) class SimpleCaptureMethods(CameraTesterBase): def test_sleep(self): cm = self.cm cam = self.cam camconfig = cam.generate_configuration([libcam.StreamRole.StillCapture]) self.assertTrue(camconfig.size == 1) streamconfig = camconfig.at(0) fmts = streamconfig.formats self.assertIsNotNone(fmts) fmts = None ret = cam.configure(camconfig) self.assertZero(ret) stream = streamconfig.stream allocator = libcam.FrameBufferAllocator(cam) ret = allocator.allocate(stream) self.assertTrue(ret > 0) num_bufs = len(allocator.buffers(stream)) reqs = [] for i in range(num_bufs): req = cam.create_request(i) self.assertIsNotNone(req) buffer = allocator.buffers(stream)[i] ret = req.add_buffer(stream, buffer) self.assertZero(ret) reqs.append(req) buffer = None ret = cam.start() self.assertZero(ret) for req in reqs: ret = cam.queue_request(req) self.assertZero(ret) reqs = None gc.collect() time.sleep(0.5) reqs = cm.get_ready_requests() self.assertTrue(len(reqs) == num_bufs) for i, req in enumerate(reqs): self.assertTrue(i == req.cookie) reqs = None gc.collect() ret = cam.stop() self.assertZero(ret) def test_select(self): cm = self.cm cam = self.cam camconfig = cam.generate_configuration([libcam.StreamRole.StillCapture]) self.assertTrue(camconfig.size == 1) streamconfig = camconfig.at(0) fmts = streamconfig.formats self.assertIsNotNone(fmts) fmts = None ret = cam.configure(camconfig) self.assertZero(ret) stream = streamconfig.stream allocator = libcam.FrameBufferAllocator(cam) ret = allocator.allocate(stream) self.assertTrue(ret > 0) num_bufs = len(allocator.buffers(stream)) reqs = [] for i in range(num_bufs): req = cam.create_request(i) self.assertIsNotNone(req) buffer = allocator.buffers(stream)[i] ret = req.add_buffer(stream, buffer) self.assertZero(ret) reqs.append(req) buffer = None ret = cam.start() self.assertZero(ret) for req in reqs: ret = cam.queue_request(req) self.assertZero(ret) reqs = None gc.collect() sel = selectors.DefaultSelector() sel.register(cm.efd, selectors.EVENT_READ) reqs = [] running = True while running: events = sel.select() for key, _ in events: os.read(key.fd, 8) ready_reqs = cm.get_ready_requests() self.assertTrue(len(ready_reqs) > 0) reqs += ready_reqs if len(reqs) == num_bufs: running = False self.assertTrue(len(reqs) == num_bufs) for i, req in enumerate(reqs): self.assertTrue(i == req.cookie) reqs = None gc.collect() ret = cam.stop() self.assertZero(ret) # Recursively expand slist's objects into olist, using seen to track already # processed objects. def _getr(slist, olist, seen):