Qt
Internal/Contributor docs for the Qt SDK. Note: These are NOT official API docs; those are found at https://doc.qt.io/
Loading...
Searching...
No Matches
qlinuxmediadevice.cpp
Go to the documentation of this file.
1// Copyright (C) 2017 The Qt Company Ltd.
2// SPDX-License-Identifier: LicenseRef-Qt-Commercial OR LGPL-3.0-only OR GPL-2.0-only OR GPL-3.0-only
3// Qt-Security score:significant reason:default
4
5#include "qeglfsintegration_p.h"
6#include "qlinuxmediadevice.h"
7#include <qeglfskmshelpers_p.h>
8
9#include <QtCore/QLoggingCategory>
10#include <QtCore/QSize>
11#include <QtCore/QRect>
12
13#include <sys/ioctl.h>
14#include <fcntl.h>
15
16#include <cstdlib> //this needs to go before mediactl/mediactl.h because it uses size_t without including it
17extern "C" {
18#include <mediactl/mediactl.h>
19#include <mediactl/v4l2subdev.h>
20}
21
22QT_BEGIN_NAMESPACE
23
24Q_DECLARE_LOGGING_CATEGORY(qLcEglfsKmsDebug)
25
26static QString mediaBusFmtToString(uint code)
27{
28 switch (code) {
29 case MEDIA_BUS_FMT_FIXED: return "FIXED";
30 case MEDIA_BUS_FMT_RGB444_1X12: return "RGB444_1X12";
31// case MEDIA_BUS_FMT_RGB444_2X8_PADHI_B: return "RGB444_2X8_PADHI_B";
32// case MEDIA_BUS_FMT_RGB444_2X8_PADHI_L: return "RGB444_2X8_PADHI_L";
33// case MEDIA_BUS_FMT_RGB555_2X8_PADHI_B: return "RGB555_2X8_PADHI_B";
34// case MEDIA_BUS_FMT_RGB555_2X8_PADHI_L: return "RGB555_2X8_PADHI_L";
35 case MEDIA_BUS_FMT_RGB565_1X16: return "RGB565_1X16";
36 case MEDIA_BUS_FMT_BGR565_2X8_BE: return "BGR565_2X8_BE";
37 case MEDIA_BUS_FMT_BGR565_2X8_LE: return "BGR565_2X8_LE";
38 case MEDIA_BUS_FMT_RGB565_2X8_BE: return "RGB565_2X8_BE";
39 case MEDIA_BUS_FMT_RGB565_2X8_LE: return "RGB565_2X8_LE";
40 case MEDIA_BUS_FMT_RGB666_1X18: return "RGB666_1X18";
41 case MEDIA_BUS_FMT_RBG888_1X24: return "RBG888_1X24";
42// case MEDIA_BUS_FMT_RGB666_1X24_CPADH: return "RGB666_1X24_CPADH";
43 case MEDIA_BUS_FMT_RGB666_1X7X3_SPWG: return "RGB666_1X7X3_SPWG";
44 case MEDIA_BUS_FMT_BGR888_1X24: return "BGR888_1X24";
45 case MEDIA_BUS_FMT_GBR888_1X24: return "GBR888_1X24";
46 case MEDIA_BUS_FMT_RGB888_1X24: return "RGB888_1X24";
47 case MEDIA_BUS_FMT_RGB888_2X12_BE: return "RGB888_2X12_BE";
48 case MEDIA_BUS_FMT_RGB888_2X12_LE: return "RGB888_2X12_LE";
49 case MEDIA_BUS_FMT_RGB888_1X7X4_SPWG: return "RGB888_1X7X4_SPWG";
50// case MEDIA_BUS_FMT_RGB888_1X7X4_JEID: return "RGB888_1X7X4_JEID";
51 case MEDIA_BUS_FMT_ARGB8888_1X32: return "ARGB8888_1X32";
52 case MEDIA_BUS_FMT_RGB888_1X32_PADHI: return "RGB888_1X32_PADHI";
53// case MEDIA_BUS_FMT_RGB101010_1X30: return "RGB101010_1X30";
54// case MEDIA_BUS_FMT_RGB121212_1X36: return "RGB121212_1X36";
55// case MEDIA_BUS_FMT_RGB161616_1X48: return "RGB161616_1X48";
56 case MEDIA_BUS_FMT_Y8_1X8: return "Y8_1X8";
57 case MEDIA_BUS_FMT_UV8_1X8: return "UV8_1X8";
58 case MEDIA_BUS_FMT_UYVY8_1_5X8: return "UYVY8_1_5X8";
59 case MEDIA_BUS_FMT_VYUY8_1_5X8: return "VYUY8_1_5X8";
60 case MEDIA_BUS_FMT_YUYV8_1_5X8: return "YUYV8_1_5X8";
61 case MEDIA_BUS_FMT_YVYU8_1_5X8: return "YVYU8_1_5X8";
62 case MEDIA_BUS_FMT_UYVY8_2X8: return "UYVY8_2X8";
63 case MEDIA_BUS_FMT_VYUY8_2X8: return "VYUY8_2X8";
64 case MEDIA_BUS_FMT_YUYV8_2X8: return "YUYV8_2X8";
65 case MEDIA_BUS_FMT_YVYU8_2X8: return "YVYU8_2X8";
66 case MEDIA_BUS_FMT_Y10_1X10: return "Y10_1X10";
67 case MEDIA_BUS_FMT_UYVY10_2X10: return "UYVY10_2X10";
68 case MEDIA_BUS_FMT_VYUY10_2X10: return "VYUY10_2X10";
69 case MEDIA_BUS_FMT_YUYV10_2X10: return "YUYV10_2X10";
70 case MEDIA_BUS_FMT_YVYU10_2X10: return "YVYU10_2X10";
71 case MEDIA_BUS_FMT_Y12_1X12: return "Y12_1X12";
72 case MEDIA_BUS_FMT_UYVY12_2X12: return "UYVY12_2X12";
73 case MEDIA_BUS_FMT_VYUY12_2X12: return "VYUY12_2X12";
74 case MEDIA_BUS_FMT_YUYV12_2X12: return "YUYV12_2X12";
75 case MEDIA_BUS_FMT_YVYU12_2X12: return "YVYU12_2X12";
76 case MEDIA_BUS_FMT_UYVY8_1X16: return "UYVY8_1X16";
77 case MEDIA_BUS_FMT_VYUY8_1X16: return "VYUY8_1X16";
78 case MEDIA_BUS_FMT_YUYV8_1X16: return "YUYV8_1X16";
79 case MEDIA_BUS_FMT_YVYU8_1X16: return "YVYU8_1X16";
80 case MEDIA_BUS_FMT_YDYUYDYV8_1X16: return "YDYUYDYV8_1X16";
81 case MEDIA_BUS_FMT_UYVY10_1X20: return "UYVY10_1X20";
82 case MEDIA_BUS_FMT_VYUY10_1X20: return "VYUY10_1X20";
83 case MEDIA_BUS_FMT_YUYV10_1X20: return "YUYV10_1X20";
84 case MEDIA_BUS_FMT_YVYU10_1X20: return "YVYU10_1X20";
85 case MEDIA_BUS_FMT_VUY8_1X24: return "VUY8_1X24";
86 case MEDIA_BUS_FMT_YUV8_1X24: return "YUV8_1X24";
87// case MEDIA_BUS_FMT_UYYVYY8_0_5X24: return "UYYVYY8_0_5X24";
88 case MEDIA_BUS_FMT_UYVY12_1X24: return "UYVY12_1X24";
89 case MEDIA_BUS_FMT_VYUY12_1X24: return "VYUY12_1X24";
90 case MEDIA_BUS_FMT_YUYV12_1X24: return "YUYV12_1X24";
91 case MEDIA_BUS_FMT_YVYU12_1X24: return "YVYU12_1X24";
92 case MEDIA_BUS_FMT_YUV10_1X30: return "YUV10_1X30";
93// case MEDIA_BUS_FMT_UYYVYY10_0_5X30: return "UYYVYY10_0_5X30";
94 case MEDIA_BUS_FMT_AYUV8_1X32: return "AYUV8_1X32";
95// case MEDIA_BUS_FMT_UYYVYY12_0_5X36: return "UYYVYY12_0_5X36";
96// case MEDIA_BUS_FMT_YUV12_1X36: return "YUV12_1X36";
97// case MEDIA_BUS_FMT_YUV16_1X48: return "YUV16_1X48";
98// case MEDIA_BUS_FMT_UYYVYY16_0_5X48: return "UYYVYY16_0_5X48";
99 case MEDIA_BUS_FMT_SBGGR8_1X8: return "SBGGR8_1X8";
100 case MEDIA_BUS_FMT_SGBRG8_1X8: return "SGBRG8_1X8";
101 case MEDIA_BUS_FMT_SGRBG8_1X8: return "SGRBG8_1X8";
102 case MEDIA_BUS_FMT_SRGGB8_1X8: return "SRGGB8_1X8";
103 case MEDIA_BUS_FMT_SBGGR10_ALAW8_1X8: return "SBGGR10_ALAW8_1X8";
104 case MEDIA_BUS_FMT_SGBRG10_ALAW8_1X8: return "SGBRG10_ALAW8_1X8";
105 case MEDIA_BUS_FMT_SGRBG10_ALAW8_1X8: return "SGRBG10_ALAW8_1X8";
106 case MEDIA_BUS_FMT_SRGGB10_ALAW8_1X8: return "SRGGB10_ALAW8_1X8";
107 case MEDIA_BUS_FMT_SBGGR10_DPCM8_1X8: return "SBGGR10_DPCM8_1X8";
108 case MEDIA_BUS_FMT_SGBRG10_DPCM8_1X8: return "SGBRG10_DPCM8_1X8";
109 case MEDIA_BUS_FMT_SGRBG10_DPCM8_1X8: return "SGRBG10_DPCM8_1X8";
110 case MEDIA_BUS_FMT_SRGGB10_DPCM8_1X8: return "SRGGB10_DPCM8_1X8";
111// case MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_B: return "SBGGR10_2X8_PADHI_B";
112// case MEDIA_BUS_FMT_SBGGR10_2X8_PADHI_L: return "SBGGR10_2X8_PADHI_L";
113// case MEDIA_BUS_FMT_SBGGR10_2X8_PADLO_B: return "SBGGR10_2X8_PADLO_B";
114// case MEDIA_BUS_FMT_SBGGR10_2X8_PADLO_L: return "SBGGR10_2X8_PADLO_L";
115 case MEDIA_BUS_FMT_SBGGR10_1X10: return "SBGGR10_1X10";
116 case MEDIA_BUS_FMT_SGBRG10_1X10: return "SGBRG10_1X10";
117 case MEDIA_BUS_FMT_SGRBG10_1X10: return "SGRBG10_1X10";
118 case MEDIA_BUS_FMT_SRGGB10_1X10: return "SRGGB10_1X10";
119 case MEDIA_BUS_FMT_SBGGR12_1X12: return "SBGGR12_1X12";
120 case MEDIA_BUS_FMT_SGBRG12_1X12: return "SGBRG12_1X12";
121 case MEDIA_BUS_FMT_SGRBG12_1X12: return "SGRBG12_1X12";
122 case MEDIA_BUS_FMT_SRGGB12_1X12: return "SRGGB12_1X12";
123 case MEDIA_BUS_FMT_SBGGR14_1X14: return "SBGGR14_1X14";
124 case MEDIA_BUS_FMT_SGBRG14_1X14: return "SGBRG14_1X14";
125 case MEDIA_BUS_FMT_SGRBG14_1X14: return "SGRBG14_1X14";
126 case MEDIA_BUS_FMT_SRGGB14_1X14: return "SRGGB14_1X14";
127 case MEDIA_BUS_FMT_SBGGR16_1X16: return "SBGGR16_1X16";
128 case MEDIA_BUS_FMT_SGBRG16_1X16: return "SGBRG16_1X16";
129 case MEDIA_BUS_FMT_SGRBG16_1X16: return "SGRBG16_1X16";
130 case MEDIA_BUS_FMT_SRGGB16_1X16: return "SRGGB16_1X16";
131 case MEDIA_BUS_FMT_JPEG_1X8: return "JPEG_1X8";
132 case MEDIA_BUS_FMT_S5C_UYVY_JPEG_1X8: return "S5C_UYVY_JPEG_1X8";
133 case MEDIA_BUS_FMT_AHSV8888_1X32: return "AHSV8888_1X32";
134 default: return QString(code);
135 }
136}
137
138static QDebug operator<<(QDebug debug, const struct v4l2_mbus_framefmt &format)
139{
140 QDebugStateSaver saver(debug);
141 debug.nospace() << "v4l2_mbus_framefmt("
142 << "code: " << mediaBusFmtToString(format.code) << ", "
143 << "size: " << format.width << "x" << format.height << ")";
144 return debug;
145}
146
147static QDebug operator<<(QDebug debug, const struct v4l2_pix_format_mplane &format)
148{
149 QDebugStateSaver saver(debug);
150 debug.nospace() << "v4l2_pix_format_mplane("
151 << "pixel format: " << q_fourccToString(format.pixelformat) << ", "
152 << "size: " << format.width << "x" << format.height << ", "
153 << "planes: " << format.num_planes << ")";
154 return debug;
155}
156
157QLinuxMediaDevice::QLinuxMediaDevice(const QString &devicePath)
158 : m_mediaDevice(media_device_new(devicePath.toStdString().c_str()))
159{
160 if (!m_mediaDevice)
161 qFatal("Couldn't get media device");
162
163 if (media_device_enumerate(m_mediaDevice))
164 qFatal("Couldn't enumerate media device");
165
166 m_info = media_get_info(m_mediaDevice);
167
168 qCDebug(qLcEglfsKmsDebug) << "Opened linux media device:"
169 << "\n\t Path:" << devicePath
170 << "\n\t Model:" << model()
171 << "\n\t Device name:" << deviceName();
172
173 resetLinks();
174}
175
176QLinuxMediaDevice::~QLinuxMediaDevice()
177{
178 if (m_mediaDevice)
179 media_device_unref(m_mediaDevice);
180}
181
182QString QLinuxMediaDevice::model()
183{
184 return QString(m_info->model);
185}
186
187QString QLinuxMediaDevice::deviceName()
188{
189 return QString(m_info->bus_info).split(":").last();
190}
191
192bool QLinuxMediaDevice::resetLinks()
193{
194 if (media_reset_links(m_mediaDevice)) {
195 qWarning() << "Could not reset media controller links.";
196 return false;
197 }
198 qCDebug(qLcEglfsKmsDebug) << "Reset media links";
199 return true;
200}
201
202struct media_link *QLinuxMediaDevice::parseLink(const QString &link)
203{
204 char *endp = nullptr;
205 struct media_link *mediaLink = media_parse_link(m_mediaDevice, link.toStdString().c_str(), &endp);
206
207 if (!mediaLink)
208 qWarning() << "Failed to parse media link:" << link;
209
210 return mediaLink;
211}
212
213struct media_pad *QLinuxMediaDevice::parsePad(const QString &pad)
214{
215 struct media_pad *mediaPad = media_parse_pad(m_mediaDevice, pad.toStdString().c_str(), nullptr);
216
217 if (!mediaPad)
218 qWarning() << "Failed to parse media pad:" << pad;
219
220 return mediaPad;
221}
222
223bool QLinuxMediaDevice::enableLink(struct media_link *link)
224{
225 if (media_setup_link(m_mediaDevice, link->source, link->sink, 1)) {
226 qWarning() << "Failed to enable media link.";
227 return false;
228 }
229 return true;
230}
231
232bool QLinuxMediaDevice::disableLink(struct media_link *link)
233{
234 if (media_setup_link(m_mediaDevice, link->source, link->sink, 0)) {
235 qWarning() << "Failed to disable media link.";
236 return false;
237 }
238 return true;
239}
240
241// Between the v4l-utils 1.10 and 1.12 releases, media_get_entity_by_name changed signature,
242// i.e. breaking source compatibility. Unfortunately the v4l-utils version is not exposed
243// through anything we can use through a regular ifdef so here we do a hack and create two
244// overloads for a function based on the signature of the function pointer argument. This
245// means that by calling safeGetEntity with media_get_entity_by_name as an argument, the
246// compiler will pick the correct version.
247//
248// v4l-utils v1.12 and later
249static struct media_entity *safeGetEntity(struct media_entity *(get_entity_by_name_fn)(struct media_device *, const char *),
250 struct media_device *device, const QString &name)
251{
252 return get_entity_by_name_fn(device, name.toStdString().c_str());
253}
254// v4l-utils v1.10 and earlier
255static struct media_entity *safeGetEntity(struct media_entity *(get_entity_by_name_fn)(struct media_device *, const char *, size_t),
256 struct media_device *device,
257 const QString &name)
258{
259 return get_entity_by_name_fn(device, name.toStdString().c_str(), name.length());
260}
261
262struct media_entity *QLinuxMediaDevice::getEntity(const QString &name)
263{
264 struct media_entity *entity = safeGetEntity(media_get_entity_by_name, m_mediaDevice, name);
265
266 if (!entity)
267 qWarning() << "Failed to get media entity:" << name;
268
269 return entity;
270}
271
272int QLinuxMediaDevice::openVideoDevice(const QString &name)
273{
274 struct media_entity *entity = getEntity(name);
275 const char *deviceName = media_entity_get_devname(entity);
276 int fd = open(deviceName, O_RDWR);
277 qCDebug(qLcEglfsKmsDebug) << "Opened video device:" << deviceName << "with fd" << fd;
278 return fd;
279}
280
281QLinuxMediaDevice::CaptureSubDevice::CaptureSubDevice(QLinuxMediaDevice *mediaDevice, const QString &name)
282 : m_subdevFd(mediaDevice->openVideoDevice(name))
283{
284}
285
286bool QLinuxMediaDevice::CaptureSubDevice::setFormat(const QSize &size, uint32_t pixelFormat)
287{
288 Q_ASSERT(size.isValid());
289 struct v4l2_format format;
290 memset(&format, 0, sizeof(struct v4l2_format));
291 format.type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
292 if (ioctl(m_subdevFd, VIDIOC_G_FMT, &format) == -1) {
293 qErrnoWarning("VIDIOC_G_FMT for capture device failed");
294 return false;
295 }
296
297 format.fmt.pix_mp.width = static_cast<uint>(size.width());
298 format.fmt.pix_mp.height = static_cast<uint>(size.height());
299 format.fmt.pix_mp.field = V4L2_FIELD_NONE;
300 format.fmt.pix_mp.pixelformat = pixelFormat;
301 format.fmt.pix_mp.num_planes = 1;
302 format.fmt.pix_mp.flags = 0;
303 format.fmt.pix_mp.plane_fmt[0].bytesperline = 0;
304 format.fmt.pix_mp.plane_fmt[0].sizeimage = 0;
305
306 if (ioctl(m_subdevFd, VIDIOC_S_FMT, &format) == -1) {
307 qWarning() << "Capture device" << m_subdevFd << "VIDIOC_S_FMT with format" << format.fmt.pix_mp
308 << "failed:" << strerror(errno);
309 return false;
310 }
311
312 qCDebug(qLcEglfsKmsDebug) << "Capture device" << m_subdevFd << "format set:" << format.fmt.pix_mp;
313 return true;
314}
315
316bool QLinuxMediaDevice::CaptureSubDevice::clearBuffers()
317{
318 struct v4l2_requestbuffers requestBuffers;
319 memset(&requestBuffers, 0, sizeof(requestBuffers));
320 requestBuffers.type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
321 requestBuffers.memory = V4L2_MEMORY_DMABUF;
322 requestBuffers.count = 0;
323 if (ioctl(m_subdevFd, VIDIOC_REQBUFS, &requestBuffers) == -1) {
324 qWarning("Capture device %d: VIDIOC_REQBUFS clear failed: %s", m_subdevFd, strerror(errno));
325 return false;
326 }
327 qCDebug(qLcEglfsKmsDebug, "Capture device %d: Deallocced buffers with REQBUF, now has %d buffers", m_subdevFd, requestBuffers.count);
328 Q_ASSERT(requestBuffers.count == 0);
329 return true;
330}
331
332bool QLinuxMediaDevice::CaptureSubDevice::requestBuffer()
333{
334 struct v4l2_requestbuffers requestBuffers;
335 memset(&requestBuffers, 0, sizeof(requestBuffers));
336 requestBuffers.type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
337 requestBuffers.memory = V4L2_MEMORY_DMABUF;
338 requestBuffers.count = 1;
339 if (ioctl(m_subdevFd, VIDIOC_REQBUFS, &requestBuffers) == -1) {
340 if (errno == EINVAL)
341 qWarning("Capture device %d: Multi-planar capture or dma buffers not supported", m_subdevFd);
342 qWarning("Capture device %d: VIDIOC_REQBUFS failed: %s", m_subdevFd, strerror(errno));
343 return false;
344 }
345 Q_ASSERT(requestBuffers.count == 1);
346 return true;
347}
348
349bool QLinuxMediaDevice::CaptureSubDevice::queueBuffer(int dmabufFd, const QSize &bufferSize)
350{
351 const uint numPlanes = 1;
352 struct v4l2_buffer buffer;
353 memset(&buffer, 0, sizeof(buffer));
354 buffer.type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
355 buffer.memory = V4L2_MEMORY_DMABUF;
356 buffer.index = 0;
357
358 struct v4l2_plane planes[VIDEO_MAX_PLANES];
359 buffer.m.planes = planes;
360 buffer.length = numPlanes;
361 memset(planes, 0, sizeof(planes));
362 for (uint i = 0; i < numPlanes; i++) {
363 buffer.m.planes[i].m.fd = dmabufFd;
364 buffer.m.planes[i].length = static_cast<uint>(bufferSize.width() * bufferSize.height() * 4); //TODO: don't harcode bpp
365 buffer.m.planes[i].bytesused = static_cast<uint>(bufferSize.width() * bufferSize.height() * 4); //TODO: don't harcode bpp
366 }
367
368 if (ioctl(m_subdevFd, VIDIOC_QBUF, &buffer) == -1) {
369 qWarning("Capture device %d: VIDIOC_QBUF failed for dma buffer with fd %d: %s",
370 m_subdevFd, dmabufFd, strerror(errno));
371 return false;
372 }
373
374 return true;
375}
376
377bool QLinuxMediaDevice::CaptureSubDevice::dequeueBuffer()
378{
379 const int numPlanes = 1;
380 struct v4l2_buffer buffer;
381 struct v4l2_plane planes[VIDEO_MAX_PLANES];
382
383 memset(&buffer, 0, sizeof(buffer));
384 buffer.type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
385 buffer.memory = V4L2_MEMORY_DMABUF;
386 buffer.index = 0;
387 buffer.m.planes = planes;
388 buffer.length = numPlanes;
389 memset(planes, 0, sizeof(planes));
390
391 if (ioctl(m_subdevFd, VIDIOC_DQBUF, &buffer) == -1) {
392 qWarning("Capture device %d: VIDIOC_DQBUF failed: %s", m_subdevFd, strerror(errno));
393 return false;
394 }
395
396 return true;
397}
398
399bool QLinuxMediaDevice::CaptureSubDevice::streamOn()
400{
401 return QLinuxMediaDevice::streamOn(m_subdevFd, V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE);
402}
403
404bool QLinuxMediaDevice::CaptureSubDevice::streamOff()
405{
406 return QLinuxMediaDevice::streamOff(m_subdevFd, V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE);
407}
408
409QLinuxMediaDevice::OutputSubDevice::OutputSubDevice(QLinuxMediaDevice *mediaDevice, const QString &name)
410 : m_subdevFd(mediaDevice->openVideoDevice(name))
411{
412}
413
414bool QLinuxMediaDevice::OutputSubDevice::setFormat(const QSize &size, uint32_t pixelFormat, uint32_t bytesPerLine)
415{
416 Q_ASSERT(size.isValid());
417 struct v4l2_format format;
418 memset(&format, 0, sizeof(struct v4l2_format));
419 format.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
420 if (ioctl(m_subdevFd, VIDIOC_G_FMT, &format) == -1) {
421 qErrnoWarning("VIDIOC_G_FMT for output device failed");
422 return false;
423 }
424
425 format.fmt.pix_mp.width = static_cast<uint>(size.width());
426 format.fmt.pix_mp.height = static_cast<uint>(size.height());
427 format.fmt.pix_mp.field = V4L2_FIELD_NONE;
428 format.fmt.pix_mp.pixelformat = pixelFormat;
429 format.fmt.pix_mp.num_planes = 1;
430 format.fmt.pix_mp.flags = 0;
431 format.fmt.pix_mp.plane_fmt[0].bytesperline = bytesPerLine;
432 format.fmt.pix_mp.plane_fmt[0].sizeimage = 0;
433
434 if (ioctl(m_subdevFd, VIDIOC_S_FMT, &format) == -1) {
435 qWarning() << "Output device" << m_subdevFd << "VIDIOC_S_FMT with format" << format.fmt.pix_mp
436 << "failed:" << strerror(errno);
437 return false;
438 }
439
440 qCDebug(qLcEglfsKmsDebug) << "Output device device" << m_subdevFd << "format set:" << format.fmt.pix_mp;
441 return true;
442}
443
444bool QLinuxMediaDevice::OutputSubDevice::clearBuffers()
445{
446 struct v4l2_requestbuffers requestBuffers;
447 memset(&requestBuffers, 0, sizeof(requestBuffers));
448 requestBuffers.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
449 requestBuffers.memory = V4L2_MEMORY_DMABUF;
450 requestBuffers.count = 0;
451 if (ioctl(m_subdevFd, VIDIOC_REQBUFS, &requestBuffers) == -1) {
452 qWarning("Output device %d: VIDIOC_REQBUFS clear failed: %s", m_subdevFd, strerror(errno));
453 return false;
454 }
455 qCDebug(qLcEglfsKmsDebug, "Output device %d: Deallocced buffers with REQBUF, now has %d buffers", m_subdevFd, requestBuffers.count);
456 Q_ASSERT(requestBuffers.count == 0);
457 return true;
458}
459
460bool QLinuxMediaDevice::OutputSubDevice::requestBuffer()
461{
462 struct v4l2_requestbuffers requestBuffers;
463 memset(&requestBuffers, 0, sizeof(requestBuffers));
464 requestBuffers.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
465 requestBuffers.memory = V4L2_MEMORY_DMABUF;
466 requestBuffers.count = 1;
467 if (ioctl(m_subdevFd, VIDIOC_REQBUFS, &requestBuffers) == -1) {
468 if (errno == EINVAL)
469 qWarning("Output device %d: Multi-planar output or dma buffers not supported", m_subdevFd);
470 qWarning("Output device %d: VIDIOC_REQBUFS failed: %s", m_subdevFd, strerror(errno));
471 return false;
472 }
473 qCDebug(qLcEglfsKmsDebug) << "REQBUF returned" << requestBuffers.count << "buffers for output device" << m_subdevFd;
474 return true;
475}
476
477bool QLinuxMediaDevice::OutputSubDevice::queueBuffer(int dmabufFd, uint bytesUsed, uint length)
478{
479 const int numPlanes = 1;
480 struct v4l2_buffer buffer;
481 memset(&buffer, 0, sizeof(buffer));
482 buffer.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
483 buffer.memory = V4L2_MEMORY_DMABUF;
484 buffer.index = 0;
485 buffer.length = numPlanes;
486 buffer.bytesused = bytesUsed;
487 buffer.field = V4L2_FIELD_NONE; //TODO: what is this?
488
489 struct v4l2_plane planes[numPlanes];
490 memset(planes, 0, sizeof(planes));
491 buffer.m.planes = planes;
492
493 for (int i = 0; i < numPlanes; i++) {
494 buffer.m.planes[i].m.fd = dmabufFd;
495 buffer.m.planes[i].length = length;
496 buffer.m.planes[i].bytesused = bytesUsed;
497 }
498
499 if (ioctl(m_subdevFd, VIDIOC_QBUF, &buffer) == -1) {
500 qWarning("Output device %d: VIDIOC_QBUF failed for dmabuf %d: %s", m_subdevFd, dmabufFd, strerror(errno));
501 return false;
502 }
503
504 if (!(buffer.flags & V4L2_BUF_FLAG_QUEUED)) {
505 qWarning() << "Queued flag not set on buffer for output device";
506 return false;
507 }
508
509 return true;
510}
511
512bool QLinuxMediaDevice::OutputSubDevice::streamOn()
513{
514 return QLinuxMediaDevice::streamOn(m_subdevFd, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE);
515}
516
517bool QLinuxMediaDevice::OutputSubDevice::streamOff()
518{
519 return QLinuxMediaDevice::streamOff(m_subdevFd, V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE);
520}
521
522int QLinuxMediaDevice::openVideoDevice(media_pad *pad)
523{
524 const char *deviceName = media_entity_get_devname(pad->entity);
525 int fd = open(deviceName, O_RDWR);
526 qCDebug(qLcEglfsKmsDebug) << "Opened video device:" << deviceName << "with fd" << fd;
527 return fd;
528}
529
530bool QLinuxMediaDevice::setSubdevFormat(struct media_pad *pad, const QSize &size, uint32_t mbusFormat)
531{
532 Q_ASSERT(size.isValid());
533 struct v4l2_mbus_framefmt format;
534 format.width = static_cast<uint>(size.width());
535 format.height = static_cast<uint>(size.height());
536 format.code = mbusFormat;
537
538 if (v4l2_subdev_set_format(pad->entity, &format, pad->index, V4L2_SUBDEV_FORMAT_ACTIVE)) {
539 qWarning() << "Setting v4l2_subdev_set_format failed for format" << format;
540 return false;
541 }
542
543 if (format.code != mbusFormat) {
544 qWarning() << "Got" << mediaBusFmtToString(format.code) << "instead of"
545 << mediaBusFmtToString(mbusFormat) << "when setting subdevice format";
546 return false;
547 }
548
549 qCDebug(qLcEglfsKmsDebug) << "Set format to" << format << "for entity" << pad->entity << "index" << pad->index;
550 return true;
551}
552
553bool QLinuxMediaDevice::setSubdevAlpha(int subdevFd, qreal alpha)
554{
555 struct v4l2_control control;
556 control.id = V4L2_CID_ALPHA_COMPONENT;
557 control.value = static_cast<__s32>(alpha * 0xff);
558 if (ioctl(subdevFd, VIDIOC_S_CTRL, &control) == -1) {
559 qErrnoWarning("Setting alpha (%d) failed", control.value);
560 return false;
561 }
562 return true;
563}
564
565bool QLinuxMediaDevice::setSubdevSelection(struct media_pad *pad, const QRect &geometry, uint target)
566{
567 Q_ASSERT(geometry.isValid());
568 struct v4l2_rect rect;
569 rect.left = geometry.left();
570 rect.top = geometry.top();
571 rect.width = static_cast<uint>(geometry.width());
572 rect.height = static_cast<uint>(geometry.height());
573
574 int ret = v4l2_subdev_set_selection(pad->entity, &rect, pad->index, target, V4L2_SUBDEV_FORMAT_ACTIVE);
575 if (ret) {
576 qWarning() << "Setting subdev selection failed.";
577 return false;
578 }
579
580 return true;
581}
582
583bool QLinuxMediaDevice::setSubdevCrop(struct media_pad *pad, const QRect &geometry)
584{
585 return setSubdevSelection(pad, geometry, V4L2_SEL_TGT_CROP);
586}
587
588bool QLinuxMediaDevice::setSubdevCompose(struct media_pad *pad, const QRect &geometry)
589{
590 return setSubdevSelection(pad, geometry, V4L2_SEL_TGT_COMPOSE);
591}
592
593bool QLinuxMediaDevice::streamOn(int subDeviceFd, v4l2_buf_type bufferType)
594{
595 if (ioctl(subDeviceFd, VIDIOC_STREAMON, &bufferType) == -1) {
596 qWarning("VIDIOC_STREAMON failed for subdevice %d: %s", subDeviceFd, strerror(errno));
597 return false;
598 }
599
600 return true;
601}
602
603bool QLinuxMediaDevice::streamOff(int subDeviceFd, v4l2_buf_type bufferType)
604{
605 if (ioctl(subDeviceFd, VIDIOC_STREAMOFF, &bufferType) == -1) {
606 qWarning("VIDIOC_STREAMOFF failed for subdevice %d: %s", subDeviceFd, strerror(errno));
607 return false;
608 }
609
610 return true;
611}
612
613QT_END_NAMESPACE
QLinuxMediaDevice::CaptureSubDevice::setFormat
bool setFormat(const QSize &size, uint32_t pixelFormat=V4L2_PIX_FMT_ABGR32)
Definition qlinuxmediadevice.cpp:286
QLinuxMediaDevice::CaptureSubDevice::CaptureSubDevice
CaptureSubDevice(QLinuxMediaDevice *mediaDevice, const QString &name)
Definition qlinuxmediadevice.cpp:281
QLinuxMediaDevice::CaptureSubDevice::queueBuffer
bool queueBuffer(int dmabufFd, const QSize &bufferSize)
Definition qlinuxmediadevice.cpp:349
QLinuxMediaDevice::OutputSubDevice::OutputSubDevice
OutputSubDevice(QLinuxMediaDevice *mediaDevice, const QString &name)
Definition qlinuxmediadevice.cpp:409
QLinuxMediaDevice::OutputSubDevice::setFormat
bool setFormat(const QSize &size, uint32_t pixelFormat, uint32_t bytesPerLine)
Definition qlinuxmediadevice.cpp:414
QLinuxMediaDevice::openVideoDevice
int openVideoDevice(const QString &name)
Definition qlinuxmediadevice.cpp:272
QLinuxMediaDevice::parseLink
struct media_link * parseLink(const QString &link)
Definition qlinuxmediadevice.cpp:202
QLinuxMediaDevice::enableLink
bool enableLink(struct media_link *link)
Definition qlinuxmediadevice.cpp:223
QLinuxMediaDevice::setSubdevCrop
static bool setSubdevCrop(struct media_pad *pad, const QRect &geometry)
Definition qlinuxmediadevice.cpp:583
QLinuxMediaDevice::disableLink
bool disableLink(struct media_link *link)
Definition qlinuxmediadevice.cpp:232
QLinuxMediaDevice::openVideoDevice
static int openVideoDevice(media_pad *pad)
Definition qlinuxmediadevice.cpp:522
QLinuxMediaDevice::parsePad
struct media_pad * parsePad(const QString &pad)
Definition qlinuxmediadevice.cpp:213
QLinuxMediaDevice::getEntity
struct media_entity * getEntity(const QString &name)
Definition qlinuxmediadevice.cpp:262
QLinuxMediaDevice::QLinuxMediaDevice
QLinuxMediaDevice(const QString &devicePath)
Definition qlinuxmediadevice.cpp:157
QLinuxMediaDevice::setSubdevCompose
static bool setSubdevCompose(struct media_pad *pad, const QRect &geometry)
Definition qlinuxmediadevice.cpp:588
Q_DECLARE_LOGGING_CATEGORY
QT_BEGIN_NAMESPACE Q_DECLARE_LOGGING_CATEGORY(lcQIORing)
safeGetEntity
static struct media_entity * safeGetEntity(struct media_entity *(get_entity_by_name_fn)(struct media_device *, const char *, size_t), struct media_device *device, const QString &name)
Definition qlinuxmediadevice.cpp:255
operator<<
static QDebug operator<<(QDebug debug, const struct v4l2_mbus_framefmt &format)
Definition qlinuxmediadevice.cpp:138
mediaBusFmtToString
static QT_BEGIN_NAMESPACE QString mediaBusFmtToString(uint code)
Definition qlinuxmediadevice.cpp:26
safeGetEntity
static struct media_entity * safeGetEntity(struct media_entity *(get_entity_by_name_fn)(struct media_device *, const char *), struct media_device *device, const QString &name)
Definition qlinuxmediadevice.cpp:249
operator<<
static QDebug operator<<(QDebug debug, const struct v4l2_pix_format_mplane &format)
Definition qlinuxmediadevice.cpp:147