Git Browser for ODROID
Code Review Sign In
git.odroid.com / yocto / linux / multimedia / gst-plugin-aml-v4l2dec / 5c9aca7b1edea2aa31f6dc4d884995aa909d7f09 / . / src / gstamlv4l2object.c
blob: 86be28a5d0b411d3bc81f683c5cd7aa0a50c0509 [file] [log] [blame]
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]1/* GStreamer
2 * Copyright (C) 2022 <xuesong.jiang@amlogic.com>
3 *
4 * This library is free software; you can redistribute it and/or
5 * modify it under the terms of the GNU Library General Public
6 * License as published by the Free Software Foundation; either
7 * version 2 of the License, or (at your option) any later version.
8 *
9 * This library is distributed in the hope that it will be useful,
10 * but WITHOUT ANY WARRANTY; without even the implied warranty of
11 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
12 * Library General Public License for more details.
13 *
14 * You should have received a copy of the GNU Library General Public
15 * License along with this library; if not, write to the
16 * Free Software Foundation, Inc., 51 Franklin Street, Suite 500,
17 * Boston, MA 02110-1335, USA.
18 */
19
20#ifdef HAVE_CONFIG_H
21#include <config.h>
22#endif
23
24#include <sys/stat.h>
25#include <fcntl.h>
26#include <errno.h>
27#include <string.h>
28#include <sys/mman.h>
29#include <sys/ioctl.h>
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]30#include <stdio.h>
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]31
32#ifdef HAVE_GUDEV
33#include <gudev/gudev.h>
34#endif
35
36#include "ext/videodev2.h"
37#include "gstamlv4l2object.h"
38
39#include "gst/gst-i18n-plugin.h"
40
41#include <gst/video/video.h>
42#include <gst/allocators/gstdmabuf.h>
43
44GST_DEBUG_CATEGORY_EXTERN(aml_v4l2_debug);
45#define GST_CAT_DEFAULT aml_v4l2_debug
46
47#define DEFAULT_PROP_DEVICE_NAME NULL
48#define DEFAULT_PROP_DEVICE_FD -1
49#define DEFAULT_PROP_FLAGS 0
50#define DEFAULT_PROP_TV_NORM 0
51#define DEFAULT_PROP_IO_MODE GST_V4L2_IO_AUTO
52
53#define ENCODED_BUFFER_SIZE (2 * 1024 * 1024)
54#define DEFAULT_EXTRA_CAPTURE_BUF_SIZE 3
55
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]56#define V4L2_CONFIG_PARM_DECODE_CFGINFO (1 << 0)
57#define V4L2_CONFIG_PARM_DECODE_PSINFO (1 << 1)
58#define V4L2_CONFIG_PARM_DECODE_HDRINFO (1 << 2)
59#define V4L2_CONFIG_PARM_DECODE_CNTINFO (1 << 3)
60
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]61enum
62{
63 PROP_0,
64 V4L2_STD_OBJECT_PROPS,
65};
66
67/*
68 * common format / caps utilities:
69 */
70typedef enum
71{
72 GST_V4L2_RAW = 1 << 0,
73 GST_V4L2_CODEC = 1 << 1,
74 GST_V4L2_TRANSPORT = 1 << 2,
75 GST_V4L2_NO_PARSE = 1 << 3,
76 GST_V4L2_ALL = 0xffff
77} GstAmlV4L2FormatFlags;
78
79typedef struct
80{
81 guint32 format;
82 gboolean dimensions;
83 GstAmlV4L2FormatFlags flags;
84} GstAmlV4L2FormatDesc;
85
86static const GstAmlV4L2FormatDesc gst_aml_v4l2_formats[] = {
87 /* RGB formats */
88 {V4L2_PIX_FMT_RGB332, TRUE, GST_V4L2_RAW},
89 {V4L2_PIX_FMT_ARGB555, TRUE, GST_V4L2_RAW},
90 {V4L2_PIX_FMT_XRGB555, TRUE, GST_V4L2_RAW},
91 {V4L2_PIX_FMT_ARGB555X, TRUE, GST_V4L2_RAW},
92 {V4L2_PIX_FMT_XRGB555X, TRUE, GST_V4L2_RAW},
93 {V4L2_PIX_FMT_RGB565, TRUE, GST_V4L2_RAW},
94 {V4L2_PIX_FMT_RGB565X, TRUE, GST_V4L2_RAW},
95 {V4L2_PIX_FMT_BGR666, TRUE, GST_V4L2_RAW},
96 {V4L2_PIX_FMT_BGR24, TRUE, GST_V4L2_RAW},
97 {V4L2_PIX_FMT_RGB24, TRUE, GST_V4L2_RAW},
98 {V4L2_PIX_FMT_ABGR32, TRUE, GST_V4L2_RAW},
99 {V4L2_PIX_FMT_XBGR32, TRUE, GST_V4L2_RAW},
100 {V4L2_PIX_FMT_ARGB32, TRUE, GST_V4L2_RAW},
101 {V4L2_PIX_FMT_XRGB32, TRUE, GST_V4L2_RAW},
102
103 /* Deprecated Packed RGB Image Formats (alpha ambiguity) */
104 {V4L2_PIX_FMT_RGB444, TRUE, GST_V4L2_RAW},
105 {V4L2_PIX_FMT_RGB555, TRUE, GST_V4L2_RAW},
106 {V4L2_PIX_FMT_RGB555X, TRUE, GST_V4L2_RAW},
107 {V4L2_PIX_FMT_BGR32, TRUE, GST_V4L2_RAW},
108 {V4L2_PIX_FMT_RGB32, TRUE, GST_V4L2_RAW},
109
110 /* Grey formats */
111 {V4L2_PIX_FMT_GREY, TRUE, GST_V4L2_RAW},
112 {V4L2_PIX_FMT_Y4, TRUE, GST_V4L2_RAW},
113 {V4L2_PIX_FMT_Y6, TRUE, GST_V4L2_RAW},
114 {V4L2_PIX_FMT_Y10, TRUE, GST_V4L2_RAW},
115 {V4L2_PIX_FMT_Y12, TRUE, GST_V4L2_RAW},
116 {V4L2_PIX_FMT_Y16, TRUE, GST_V4L2_RAW},
117 {V4L2_PIX_FMT_Y16_BE, TRUE, GST_V4L2_RAW},
118 {V4L2_PIX_FMT_Y10BPACK, TRUE, GST_V4L2_RAW},
119
120 /* Palette formats */
121 {V4L2_PIX_FMT_PAL8, TRUE, GST_V4L2_RAW},
122
123 /* Chrominance formats */
124 {V4L2_PIX_FMT_UV8, TRUE, GST_V4L2_RAW},
125
126 /* Luminance+Chrominance formats */
127 {V4L2_PIX_FMT_YVU410, TRUE, GST_V4L2_RAW},
128 {V4L2_PIX_FMT_YVU420, TRUE, GST_V4L2_RAW},
129 {V4L2_PIX_FMT_YVU420M, TRUE, GST_V4L2_RAW},
130 {V4L2_PIX_FMT_YUYV, TRUE, GST_V4L2_RAW},
131 {V4L2_PIX_FMT_YYUV, TRUE, GST_V4L2_RAW},
132 {V4L2_PIX_FMT_YVYU, TRUE, GST_V4L2_RAW},
133 {V4L2_PIX_FMT_UYVY, TRUE, GST_V4L2_RAW},
134 {V4L2_PIX_FMT_VYUY, TRUE, GST_V4L2_RAW},
135 {V4L2_PIX_FMT_YUV422P, TRUE, GST_V4L2_RAW},
136 {V4L2_PIX_FMT_YUV411P, TRUE, GST_V4L2_RAW},
137 {V4L2_PIX_FMT_Y41P, TRUE, GST_V4L2_RAW},
138 {V4L2_PIX_FMT_YUV444, TRUE, GST_V4L2_RAW},
139 {V4L2_PIX_FMT_YUV555, TRUE, GST_V4L2_RAW},
140 {V4L2_PIX_FMT_YUV565, TRUE, GST_V4L2_RAW},
141 {V4L2_PIX_FMT_YUV32, TRUE, GST_V4L2_RAW},
142 {V4L2_PIX_FMT_YUV410, TRUE, GST_V4L2_RAW},
143 {V4L2_PIX_FMT_YUV420, TRUE, GST_V4L2_RAW},
144 {V4L2_PIX_FMT_YUV420M, TRUE, GST_V4L2_RAW},
145 {V4L2_PIX_FMT_HI240, TRUE, GST_V4L2_RAW},
146 {V4L2_PIX_FMT_HM12, TRUE, GST_V4L2_RAW},
147 {V4L2_PIX_FMT_M420, TRUE, GST_V4L2_RAW},
148
149 /* two planes -- one Y, one Cr + Cb interleaved */
150 {V4L2_PIX_FMT_NV12, TRUE, GST_V4L2_RAW},
151 {V4L2_PIX_FMT_NV12M, TRUE, GST_V4L2_RAW},
152 {V4L2_PIX_FMT_NV12MT, TRUE, GST_V4L2_RAW},
153 {V4L2_PIX_FMT_NV12MT_16X16, TRUE, GST_V4L2_RAW},
154 {V4L2_PIX_FMT_NV21, TRUE, GST_V4L2_RAW},
155 {V4L2_PIX_FMT_NV21M, TRUE, GST_V4L2_RAW},
156 {V4L2_PIX_FMT_NV16, TRUE, GST_V4L2_RAW},
157 {V4L2_PIX_FMT_NV16M, TRUE, GST_V4L2_RAW},
158 {V4L2_PIX_FMT_NV61, TRUE, GST_V4L2_RAW},
159 {V4L2_PIX_FMT_NV61M, TRUE, GST_V4L2_RAW},
160 {V4L2_PIX_FMT_NV24, TRUE, GST_V4L2_RAW},
161 {V4L2_PIX_FMT_NV42, TRUE, GST_V4L2_RAW},
162
163 /* Bayer formats - see http://www.siliconimaging.com/RGB%20Bayer.htm */
164 {V4L2_PIX_FMT_SBGGR8, TRUE, GST_V4L2_RAW},
165 {V4L2_PIX_FMT_SGBRG8, TRUE, GST_V4L2_RAW},
166 {V4L2_PIX_FMT_SGRBG8, TRUE, GST_V4L2_RAW},
167 {V4L2_PIX_FMT_SRGGB8, TRUE, GST_V4L2_RAW},
168
169 /* compressed formats */
170 {V4L2_PIX_FMT_MJPEG, FALSE, GST_V4L2_CODEC},
171 {V4L2_PIX_FMT_JPEG, FALSE, GST_V4L2_CODEC},
172 {V4L2_PIX_FMT_PJPG, FALSE, GST_V4L2_CODEC},
173 {V4L2_PIX_FMT_DV, FALSE, GST_V4L2_TRANSPORT},
174 {V4L2_PIX_FMT_MPEG, FALSE, GST_V4L2_TRANSPORT},
175 {V4L2_PIX_FMT_FWHT, FALSE, GST_V4L2_CODEC},
176 {V4L2_PIX_FMT_H264, FALSE, GST_V4L2_CODEC},
177 {V4L2_PIX_FMT_H264_NO_SC, FALSE, GST_V4L2_CODEC},
178 {V4L2_PIX_FMT_H264_MVC, FALSE, GST_V4L2_CODEC},
179 {V4L2_PIX_FMT_HEVC, FALSE, GST_V4L2_CODEC},
180 {V4L2_PIX_FMT_H263, FALSE, GST_V4L2_CODEC},
181 {V4L2_PIX_FMT_MPEG1, FALSE, GST_V4L2_CODEC},
182 {V4L2_PIX_FMT_MPEG2, FALSE, GST_V4L2_CODEC},
183 {V4L2_PIX_FMT_MPEG4, FALSE, GST_V4L2_CODEC},
184 {V4L2_PIX_FMT_XVID, FALSE, GST_V4L2_CODEC},
185 {V4L2_PIX_FMT_VC1_ANNEX_G, FALSE, GST_V4L2_CODEC},
186 {V4L2_PIX_FMT_VC1_ANNEX_L, FALSE, GST_V4L2_CODEC},
187 {V4L2_PIX_FMT_VP8, FALSE, GST_V4L2_CODEC | GST_V4L2_NO_PARSE},
188 {V4L2_PIX_FMT_VP9, FALSE, GST_V4L2_CODEC | GST_V4L2_NO_PARSE},
189 {V4L2_PIX_FMT_AV1, FALSE, GST_V4L2_CODEC | GST_V4L2_NO_PARSE},
190
191 /* Vendor-specific formats */
192 {V4L2_PIX_FMT_WNVA, TRUE, GST_V4L2_CODEC},
193 {V4L2_PIX_FMT_SN9C10X, TRUE, GST_V4L2_CODEC},
194 {V4L2_PIX_FMT_PWC1, TRUE, GST_V4L2_CODEC},
195 {V4L2_PIX_FMT_PWC2, TRUE, GST_V4L2_CODEC},
196};
197
198#define GST_AML_V4L2_FORMAT_COUNT (G_N_ELEMENTS(gst_aml_v4l2_formats))
199
200static GSList *gst_aml_v4l2_object_get_format_list(GstAmlV4l2Object *v4l2object);
201
202#define GST_TYPE_AML_V4L2_DEVICE_FLAGS (gst_aml_v4l2_device_get_type())
203static GType
204gst_aml_v4l2_device_get_type(void)
205{
206 static GType v4l2_device_type = 0;
207
208 if (v4l2_device_type == 0)
209 {
210 static const GFlagsValue values[] = {
211 {V4L2_CAP_VIDEO_CAPTURE, "Device supports video capture", "capture"},
212 {V4L2_CAP_VIDEO_OUTPUT, "Device supports video playback", "output"},
213 {V4L2_CAP_VIDEO_OVERLAY, "Device supports video overlay", "overlay"},
214
215 {V4L2_CAP_VBI_CAPTURE, "Device supports the VBI capture", "vbi-capture"},
216 {V4L2_CAP_VBI_OUTPUT, "Device supports the VBI output", "vbi-output"},
217
218 {V4L2_CAP_TUNER, "Device has a tuner or modulator", "tuner"},
219 {V4L2_CAP_AUDIO, "Device has audio inputs or outputs", "audio"},
220
221 {0, NULL, NULL}};
222
223 v4l2_device_type =
224 g_flags_register_static("GstAmlV4l2DeviceTypeFlags", values);
225 }
226
227 return v4l2_device_type;
228}
229
230GType gst_aml_v4l2_io_mode_get_type(void)
231{
232 static GType v4l2_io_mode = 0;
233
234 if (!v4l2_io_mode)
235 {
236 static const GEnumValue io_modes[] = {
237 {GST_V4L2_IO_AUTO, "GST_V4L2_IO_AUTO", "auto"},
238 {GST_V4L2_IO_RW, "GST_V4L2_IO_RW", "rw"},
239 {GST_V4L2_IO_MMAP, "GST_V4L2_IO_MMAP", "mmap"},
240 {GST_V4L2_IO_USERPTR, "GST_V4L2_IO_USERPTR", "userptr"},
241 {GST_V4L2_IO_DMABUF, "GST_V4L2_IO_DMABUF", "dmabuf"},
242 {GST_V4L2_IO_DMABUF_IMPORT, "GST_V4L2_IO_DMABUF_IMPORT",
243 "dmabuf-import"},
244
245 {0, NULL, NULL}};
246 v4l2_io_mode = g_enum_register_static("GstAmlV4l2IOMode", io_modes);
247 }
248 return v4l2_io_mode;
249}
250
251void gst_aml_v4l2_object_install_properties_helper(GObjectClass *gobject_class,
252 const char *default_device)
253{
254 g_object_class_install_property(gobject_class, PROP_DEVICE,
255 g_param_spec_string("device", "Device", "Device location",
256 default_device, G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
257 g_object_class_install_property(gobject_class, PROP_DEVICE_NAME,
258 g_param_spec_string("device-name", "Device name",
259 "Name of the device", DEFAULT_PROP_DEVICE_NAME,
260 G_PARAM_READABLE | G_PARAM_STATIC_STRINGS));
261 g_object_class_install_property(gobject_class, PROP_DEVICE_FD,
262 g_param_spec_int("device-fd", "File descriptor",
263 "File descriptor of the device", -1, G_MAXINT, DEFAULT_PROP_DEVICE_FD,
264 G_PARAM_READABLE | G_PARAM_STATIC_STRINGS));
265 g_object_class_install_property(gobject_class, PROP_FLAGS,
266 g_param_spec_flags("flags", "Flags", "Device type flags",
267 GST_TYPE_AML_V4L2_DEVICE_FLAGS, DEFAULT_PROP_FLAGS,
268 G_PARAM_READABLE | G_PARAM_STATIC_STRINGS));
269
270 /**
271 * GstV4l2Src:brightness:
272 *
273 * Picture brightness, or more precisely, the black level
274 */
275 g_object_class_install_property(gobject_class, PROP_BRIGHTNESS,
276 g_param_spec_int("brightness", "Brightness",
277 "Picture brightness, or more precisely, the black level", G_MININT,
278 G_MAXINT, 0,
279 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS | GST_PARAM_CONTROLLABLE));
280 /**
281 * GstV4l2Src:contrast:
282 *
283 * Picture contrast or luma gain
284 */
285 g_object_class_install_property(gobject_class, PROP_CONTRAST,
286 g_param_spec_int("contrast", "Contrast",
287 "Picture contrast or luma gain", G_MININT,
288 G_MAXINT, 0,
289 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS | GST_PARAM_CONTROLLABLE));
290 /**
291 * GstV4l2Src:saturation:
292 *
293 * Picture color saturation or chroma gain
294 */
295 g_object_class_install_property(gobject_class, PROP_SATURATION,
296 g_param_spec_int("saturation", "Saturation",
297 "Picture color saturation or chroma gain", G_MININT,
298 G_MAXINT, 0,
299 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS | GST_PARAM_CONTROLLABLE));
300 /**
301 * GstV4l2Src:hue:
302 *
303 * Hue or color balance
304 */
305 g_object_class_install_property(gobject_class, PROP_HUE,
306 g_param_spec_int("hue", "Hue",
307 "Hue or color balance", G_MININT,
308 G_MAXINT, 0,
309 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS | GST_PARAM_CONTROLLABLE));
310
311 /**
312 * GstV4l2Src:io-mode:
313 *
314 * IO Mode
315 */
316 g_object_class_install_property(gobject_class, PROP_IO_MODE,
317 g_param_spec_enum("io-mode", "IO mode",
318 "I/O mode",
319 GST_TYPE_AML_V4L2_IO_MODE, DEFAULT_PROP_IO_MODE,
320 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
321
322 /**
323 * GstV4l2Src:extra-controls:
324 *
325 * Additional v4l2 controls for the device. The controls are identified
326 * by the control name (lowercase with '_' for any non-alphanumeric
327 * characters).
328 *
329 * Since: 1.2
330 */
331 g_object_class_install_property(gobject_class, PROP_EXTRA_CONTROLS,
332 g_param_spec_boxed("extra-controls", "Extra Controls",
333 "Extra v4l2 controls (CIDs) for the device",
334 GST_TYPE_STRUCTURE, G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
335
336 /**
337 * GstV4l2Src:pixel-aspect-ratio:
338 *
339 * The pixel aspect ratio of the device. This overwrites the pixel aspect
340 * ratio queried from the device.
341 *
342 * Since: 1.2
343 */
344 g_object_class_install_property(gobject_class, PROP_PIXEL_ASPECT_RATIO,
345 g_param_spec_string("pixel-aspect-ratio", "Pixel Aspect Ratio",
346 "Overwrite the pixel aspect ratio of the device", "1/1",
347 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
348
349 /**
350 * GstV4l2Src:force-aspect-ratio:
351 *
352 * When enabled, the pixel aspect ratio queried from the device or set
353 * with the pixel-aspect-ratio property will be enforced.
354 *
355 * Since: 1.2
356 */
357 g_object_class_install_property(gobject_class, PROP_FORCE_ASPECT_RATIO,
358 g_param_spec_boolean("force-aspect-ratio", "Force aspect ratio",
359 "When enabled, the pixel aspect ratio will be enforced", TRUE,
360 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
361}
362
363void gst_aml_v4l2_object_install_m2m_properties_helper(GObjectClass *gobject_class)
364{
365 g_object_class_install_property(gobject_class, PROP_DEVICE,
366 g_param_spec_string("device", "Device", "Device location",
367 NULL, G_PARAM_READABLE | G_PARAM_STATIC_STRINGS));
368
369 g_object_class_install_property(gobject_class, PROP_DEVICE_NAME,
370 g_param_spec_string("device-name", "Device name",
371 "Name of the device", DEFAULT_PROP_DEVICE_NAME,
372 G_PARAM_READABLE | G_PARAM_STATIC_STRINGS));
373
374 g_object_class_install_property(gobject_class, PROP_DEVICE_FD,
375 g_param_spec_int("device-fd", "File descriptor",
376 "File descriptor of the device", -1, G_MAXINT, DEFAULT_PROP_DEVICE_FD,
377 G_PARAM_READABLE | G_PARAM_STATIC_STRINGS));
378
379 g_object_class_install_property(gobject_class, PROP_OUTPUT_IO_MODE,
380 g_param_spec_enum("output-io-mode", "Output IO mode",
381 "Output side I/O mode (matches sink pad)",
382 GST_TYPE_AML_V4L2_IO_MODE, DEFAULT_PROP_IO_MODE,
383 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
384
385 g_object_class_install_property(gobject_class, PROP_CAPTURE_IO_MODE,
386 g_param_spec_enum("capture-io-mode", "Capture IO mode",
387 "Capture I/O mode (matches src pad)",
388 GST_TYPE_AML_V4L2_IO_MODE, DEFAULT_PROP_IO_MODE,
389 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
390
391 g_object_class_install_property(gobject_class, PROP_EXTRA_CONTROLS,
392 g_param_spec_boxed("extra-controls", "Extra Controls",
393 "Extra v4l2 controls (CIDs) for the device",
394 GST_TYPE_STRUCTURE, G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
395
396 g_object_class_install_property(gobject_class, PROP_DUMP_FRAME_LOCATION,
397 g_param_spec_string("dump-frame-location", "dump frame location",
398 "Location of the file to write decoder frames", NULL,
399 G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
400}
401
402/* Support for 32bit off_t, this wrapper is casting off_t to gint64 */
403#ifdef HAVE_LIBV4L2
404#if SIZEOF_OFF_T < 8
405
406static gpointer
407v4l2_mmap_wrapper(gpointer start, gsize length, gint prot, gint flags, gint fd,
408 off_t offset)
409{
410 return v4l2_mmap(start, length, prot, flags, fd, (gint64)offset);
411}
412
413#define v4l2_mmap v4l2_mmap_wrapper
414
415#endif /* SIZEOF_OFF_T < 8 */
416#endif /* HAVE_LIBV4L2 */
417
418GstAmlV4l2Object *
419gst_aml_v4l2_object_new(GstElement *element,
420 GstObject *debug_object,
421 enum v4l2_buf_type type,
422 const char *default_device,
423 GstAmlV4l2GetInOutFunction get_in_out_func,
424 GstAmlV4l2SetInOutFunction set_in_out_func,
425 GstAmlV4l2UpdateFpsFunction update_fps_func)
426{
427 GstAmlV4l2Object *v4l2object;
428
429 /*
430 * some default values
431 */
432 v4l2object = g_new0(GstAmlV4l2Object, 1);
433
434 if ((V4L2_BUF_TYPE_VIDEO_CAPTURE == type || V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE == type))
435 {
436 const char *default_mode = getenv("GST_DEFAULT_V4L2_BUF_MODE");
437 GST_DEBUG("amlmodbuf GST_AML_DEFAULT_V4L2_BUF_MODE:%s", default_mode);
438 if (default_mode)
439 {
440 if (strcmp(default_mode, "DMA_BUF_IMPORT") == 0)
441 v4l2object->req_mode = GST_V4L2_IO_DMABUF_IMPORT;
442 else if (strcmp(default_mode, "DMA_BUF") == 0)
443 v4l2object->req_mode = GST_V4L2_IO_DMABUF;
444 GST_DEBUG("amlmodbuf set default buf default_mode:%d", v4l2object->req_mode);
445 }
446 }
447
448 v4l2object->type = type;
449 v4l2object->formats = NULL;
450
451 v4l2object->element = element;
452 v4l2object->dbg_obj = debug_object;
453 v4l2object->get_in_out_func = get_in_out_func;
454 v4l2object->set_in_out_func = set_in_out_func;
455 v4l2object->update_fps_func = update_fps_func;
456
457 v4l2object->video_fd = -1;
458 v4l2object->active = FALSE;
459 v4l2object->videodev = g_strdup(default_device);
460
461 v4l2object->norms = NULL;
462 v4l2object->channels = NULL;
463 v4l2object->colors = NULL;
464
465 v4l2object->keep_aspect = TRUE;
466
467 v4l2object->n_v4l2_planes = 0;
468
469 v4l2object->no_initial_format = FALSE;
470
471 /* We now disable libv4l2 by default, but have an env to enable it. */
472#ifdef HAVE_LIBV4L2
473 if (g_getenv("GST_V4L2_USE_LIBV4L2"))
474 {
475 v4l2object->fd_open = v4l2_fd_open;
476 v4l2object->close = v4l2_close;
477 v4l2object->dup = v4l2_dup;
478 v4l2object->ioctl = v4l2_ioctl;
479 v4l2object->read = v4l2_read;
480 v4l2object->mmap = v4l2_mmap;
481 v4l2object->munmap = v4l2_munmap;
482 }
483 else
484#endif
485 {
486 v4l2object->fd_open = NULL;
487 v4l2object->close = close;
488 v4l2object->dup = dup;
489 v4l2object->ioctl = ioctl;
490 v4l2object->read = read;
491 v4l2object->mmap = mmap;
492 v4l2object->munmap = munmap;
493 }
494 v4l2object->poll = gst_poll_new(TRUE);
495 v4l2object->can_wait_event = FALSE;
496 v4l2object->can_poll_device = TRUE;
497 v4l2object->tvin_port = -1;
498
499 v4l2object->dumpframefile = NULL;
500
501 return v4l2object;
502}
503
504static gboolean gst_aml_v4l2_object_clear_format_list(GstAmlV4l2Object *v4l2object);
505
506void gst_aml_v4l2_object_destroy(GstAmlV4l2Object *v4l2object)
507{
508 g_return_if_fail(v4l2object != NULL);
509
510 g_free(v4l2object->videodev);
511
512 g_free(v4l2object->channel);
513
514 if (v4l2object->formats)
515 {
516 gst_aml_v4l2_object_clear_format_list(v4l2object);
517 }
518
519 if (v4l2object->probed_caps)
520 {
521 gst_caps_unref(v4l2object->probed_caps);
522 }
523
524 if (v4l2object->extra_controls)
525 {
526 gst_structure_free(v4l2object->extra_controls);
527 }
528
529 gst_poll_free(v4l2object->poll);
530
531 g_free(v4l2object->dumpframefile);
532
533 g_free(v4l2object);
534}
535
536static gboolean
537gst_aml_v4l2_object_clear_format_list(GstAmlV4l2Object *v4l2object)
538{
539 g_slist_foreach(v4l2object->formats, (GFunc)g_free, NULL);
540 g_slist_free(v4l2object->formats);
541 v4l2object->formats = NULL;
542
543 return TRUE;
544}
545
546static gint
547gst_aml_v4l2_object_prop_to_cid(guint prop_id)
548{
549 gint cid = -1;
550
551 switch (prop_id)
552 {
553 case PROP_BRIGHTNESS:
554 cid = V4L2_CID_BRIGHTNESS;
555 break;
556 case PROP_CONTRAST:
557 cid = V4L2_CID_CONTRAST;
558 break;
559 case PROP_SATURATION:
560 cid = V4L2_CID_SATURATION;
561 break;
562 case PROP_HUE:
563 cid = V4L2_CID_HUE;
564 break;
565 default:
566 GST_WARNING("unmapped property id: %d", prop_id);
567 }
568 return cid;
569}
570
571gboolean
572gst_aml_v4l2_object_set_property_helper(GstAmlV4l2Object *v4l2object,
573 guint prop_id, const GValue *value, GParamSpec *pspec)
574{
575 switch (prop_id)
576 {
577 case PROP_DEVICE:
578 g_free(v4l2object->videodev);
579 v4l2object->videodev = g_value_dup_string(value);
580 break;
581 case PROP_BRIGHTNESS:
582 case PROP_CONTRAST:
583 case PROP_SATURATION:
584 case PROP_HUE:
585 {
586 gint cid = gst_aml_v4l2_object_prop_to_cid(prop_id);
587
588 if (cid != -1)
589 {
590 if (GST_AML_V4L2_IS_OPEN(v4l2object))
591 {
592 gst_aml_v4l2_set_attribute(v4l2object, cid, g_value_get_int(value));
593 }
594 }
595 return TRUE;
596 }
597 break;
598 case PROP_IO_MODE:
599 v4l2object->req_mode = g_value_get_enum(value);
600 break;
601 case PROP_CAPTURE_IO_MODE:
602 g_return_val_if_fail(!V4L2_TYPE_IS_OUTPUT(v4l2object->type), FALSE);
603 v4l2object->req_mode = g_value_get_enum(value);
604 break;
605 case PROP_OUTPUT_IO_MODE:
606 g_return_val_if_fail(V4L2_TYPE_IS_OUTPUT(v4l2object->type), FALSE);
607 v4l2object->req_mode = g_value_get_enum(value);
608 break;
609 case PROP_EXTRA_CONTROLS:
610 {
611 const GstStructure *s = gst_value_get_structure(value);
612
613 if (v4l2object->extra_controls)
614 gst_structure_free(v4l2object->extra_controls);
615
616 v4l2object->extra_controls = s ? gst_structure_copy(s) : NULL;
617 if (GST_AML_V4L2_IS_OPEN(v4l2object))
618 gst_aml_v4l2_set_controls(v4l2object, v4l2object->extra_controls);
619 break;
620 }
621 case PROP_PIXEL_ASPECT_RATIO:
622 if (v4l2object->par)
623 {
624 g_value_unset(v4l2object->par);
625 g_free(v4l2object->par);
626 }
627 v4l2object->par = g_new0(GValue, 1);
628 g_value_init(v4l2object->par, GST_TYPE_FRACTION);
629 if (!g_value_transform(value, v4l2object->par))
630 {
631 g_warning("Could not transform string to aspect ratio");
632 gst_value_set_fraction(v4l2object->par, 1, 1);
633 }
634
635 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "set PAR to %d/%d",
636 gst_value_get_fraction_numerator(v4l2object->par),
637 gst_value_get_fraction_denominator(v4l2object->par));
638 break;
639 case PROP_FORCE_ASPECT_RATIO:
640 v4l2object->keep_aspect = g_value_get_boolean(value);
641 break;
642 case PROP_DUMP_FRAME_LOCATION:
643 g_free(v4l2object->dumpframefile);
644 v4l2object->dumpframefile = g_value_dup_string(value);
645 break;
646 default:
647 return FALSE;
648 break;
649 }
650 return TRUE;
651}
652
653gboolean
654gst_aml_v4l2_object_get_property_helper(GstAmlV4l2Object *v4l2object,
655 guint prop_id, GValue *value, GParamSpec *pspec)
656{
657 switch (prop_id)
658 {
659 case PROP_DEVICE:
660 g_value_set_string(value, v4l2object->videodev);
661 break;
662 case PROP_DEVICE_NAME:
663 {
664 const guchar *name = NULL;
665
666 if (GST_AML_V4L2_IS_OPEN(v4l2object))
667 name = v4l2object->vcap.card;
668
669 g_value_set_string(value, (gchar *)name);
670 break;
671 }
672 case PROP_DEVICE_FD:
673 {
674 if (GST_AML_V4L2_IS_OPEN(v4l2object))
675 g_value_set_int(value, v4l2object->video_fd);
676 else
677 g_value_set_int(value, DEFAULT_PROP_DEVICE_FD);
678 break;
679 }
680 case PROP_FLAGS:
681 {
682 guint flags = 0;
683
684 if (GST_AML_V4L2_IS_OPEN(v4l2object))
685 {
686 flags |= v4l2object->device_caps &
687 (V4L2_CAP_VIDEO_CAPTURE |
688 V4L2_CAP_VIDEO_OUTPUT |
689 V4L2_CAP_VIDEO_OVERLAY |
690 V4L2_CAP_VBI_CAPTURE |
691 V4L2_CAP_VBI_OUTPUT | V4L2_CAP_TUNER | V4L2_CAP_AUDIO);
692
693 if (v4l2object->device_caps & V4L2_CAP_VIDEO_CAPTURE_MPLANE)
694 flags |= V4L2_CAP_VIDEO_CAPTURE;
695
696 if (v4l2object->device_caps & V4L2_CAP_VIDEO_OUTPUT_MPLANE)
697 flags |= V4L2_CAP_VIDEO_OUTPUT;
698 }
699 g_value_set_flags(value, flags);
700 break;
701 }
702 case PROP_BRIGHTNESS:
703 case PROP_CONTRAST:
704 case PROP_SATURATION:
705 case PROP_HUE:
706 {
707 gint cid = gst_aml_v4l2_object_prop_to_cid(prop_id);
708
709 if (cid != -1)
710 {
711 if (GST_AML_V4L2_IS_OPEN(v4l2object))
712 {
713 gint v;
714 if (gst_aml_v4l2_get_attribute(v4l2object, cid, &v))
715 {
716 g_value_set_int(value, v);
717 }
718 }
719 }
720 return TRUE;
721 }
722 break;
723 case PROP_IO_MODE:
724 g_value_set_enum(value, v4l2object->req_mode);
725 break;
726 case PROP_CAPTURE_IO_MODE:
727 g_return_val_if_fail(!V4L2_TYPE_IS_OUTPUT(v4l2object->type), FALSE);
728 g_value_set_enum(value, v4l2object->req_mode);
729 break;
730 case PROP_OUTPUT_IO_MODE:
731 g_return_val_if_fail(V4L2_TYPE_IS_OUTPUT(v4l2object->type), FALSE);
732 g_value_set_enum(value, v4l2object->req_mode);
733 break;
734 case PROP_EXTRA_CONTROLS:
735 gst_value_set_structure(value, v4l2object->extra_controls);
736 break;
737 case PROP_PIXEL_ASPECT_RATIO:
738 if (v4l2object->par)
739 g_value_transform(v4l2object->par, value);
740 break;
741 case PROP_FORCE_ASPECT_RATIO:
742 g_value_set_boolean(value, v4l2object->keep_aspect);
743 break;
744 case PROP_DUMP_FRAME_LOCATION:
745 g_value_set_string(value, v4l2object->dumpframefile);
746 break;
747 default:
748 return FALSE;
749 break;
750 }
751 return TRUE;
752}
753
754static void
755gst_aml_v4l2_get_driver_min_buffers(GstAmlV4l2Object *v4l2object)
756{
757 struct v4l2_control control = {
758 0,
759 };
760
761 g_return_if_fail(GST_AML_V4L2_IS_OPEN(v4l2object));
762
763 if (V4L2_TYPE_IS_OUTPUT(v4l2object->type))
764 control.id = V4L2_CID_MIN_BUFFERS_FOR_OUTPUT;
765 else
766 control.id = V4L2_CID_MIN_BUFFERS_FOR_CAPTURE;
767
768 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_CTRL, &control) == 0)
769 {
770 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
771 "driver requires a minimum of %d buffers", control.value);
772 v4l2object->min_buffers = control.value;
773 }
774 else
775 {
776 v4l2object->min_buffers = 0;
777 }
778}
779
780gboolean
781gst_aml_v4l2_object_open(GstAmlV4l2Object *v4l2object)
782{
783 if (!gst_aml_v4l2_open(v4l2object))
784 return FALSE;
785
786 return TRUE;
787}
788
789gboolean
790gst_aml_v4l2_object_open_shared(GstAmlV4l2Object *v4l2object, GstAmlV4l2Object *other)
791{
792 gboolean ret;
793
794 ret = gst_aml_v4l2_dup(v4l2object, other);
795
796 if (ret && !V4L2_TYPE_IS_OUTPUT(v4l2object->type))
797 {
798 gst_poll_fd_init(&v4l2object->pollfd);
799 v4l2object->pollfd.fd = v4l2object->video_fd;
800 gst_poll_add_fd(v4l2object->poll, &v4l2object->pollfd);
801 /* used for dequeue event */
802 gst_poll_fd_ctl_read(v4l2object->poll, &v4l2object->pollfd, TRUE);
803 gst_poll_fd_ctl_pri(v4l2object->poll, &v4l2object->pollfd, TRUE);
804 }
805
806 return ret;
807}
808
809gboolean
810gst_aml_v4l2_object_close(GstAmlV4l2Object *v4l2object)
811{
812 if (!gst_aml_v4l2_close(v4l2object))
813 return FALSE;
814
815 gst_caps_replace(&v4l2object->probed_caps, NULL);
816
817 /* reset our copy of the device caps */
818 v4l2object->device_caps = 0;
819
820 if (v4l2object->formats)
821 {
822 gst_aml_v4l2_object_clear_format_list(v4l2object);
823 }
824
825 if (v4l2object->par)
826 {
827 g_value_unset(v4l2object->par);
828 g_free(v4l2object->par);
829 v4l2object->par = NULL;
830 }
831
832 if (v4l2object->channel)
833 {
834 g_free(v4l2object->channel);
835 v4l2object->channel = NULL;
836 }
837
838 return TRUE;
839}
840
841static struct v4l2_fmtdesc *
842gst_aml_v4l2_object_get_format_from_fourcc(GstAmlV4l2Object *v4l2object,
843 guint32 fourcc)
844{
845 struct v4l2_fmtdesc *fmt;
846 GSList *walk;
847
848 if (fourcc == 0)
849 return NULL;
850
851 walk = gst_aml_v4l2_object_get_format_list(v4l2object);
852 while (walk)
853 {
854 fmt = (struct v4l2_fmtdesc *)walk->data;
855 if (fmt->pixelformat == fourcc)
856 return fmt;
857 /* special case for jpeg */
858 if (fmt->pixelformat == V4L2_PIX_FMT_MJPEG ||
859 fmt->pixelformat == V4L2_PIX_FMT_JPEG ||
860 fmt->pixelformat == V4L2_PIX_FMT_PJPG)
861 {
862 if (fourcc == V4L2_PIX_FMT_JPEG || fourcc == V4L2_PIX_FMT_MJPEG ||
863 fourcc == V4L2_PIX_FMT_PJPG)
864 {
865 return fmt;
866 }
867 }
868 walk = g_slist_next(walk);
869 }
870
871 return NULL;
872}
873
874/* complete made up ranking, the values themselves are meaningless */
875/* These ranks MUST be X such that X<<15 fits on a signed int - see
876 the comment at the end of gst_aml_v4l2_object_format_get_rank. */
877#define YUV_BASE_RANK 1000
878#define JPEG_BASE_RANK 500
879#define DV_BASE_RANK 200
880#define RGB_BASE_RANK 100
881#define YUV_ODD_BASE_RANK 50
882#define RGB_ODD_BASE_RANK 25
883#define BAYER_BASE_RANK 15
884#define S910_BASE_RANK 10
885#define GREY_BASE_RANK 5
886#define PWC_BASE_RANK 1
887
888static gint
889gst_aml_v4l2_object_format_get_rank(const struct v4l2_fmtdesc *fmt)
890{
891 guint32 fourcc = fmt->pixelformat;
892 gboolean emulated = ((fmt->flags & V4L2_FMT_FLAG_EMULATED) != 0);
893 gint rank = 0;
894
895 switch (fourcc)
896 {
897 case V4L2_PIX_FMT_MJPEG:
898 case V4L2_PIX_FMT_PJPG:
899 rank = JPEG_BASE_RANK;
900 break;
901 case V4L2_PIX_FMT_JPEG:
902 rank = JPEG_BASE_RANK + 1;
903 break;
904 case V4L2_PIX_FMT_MPEG: /* MPEG */
905 rank = JPEG_BASE_RANK + 2;
906 break;
907
908 case V4L2_PIX_FMT_RGB332:
909 case V4L2_PIX_FMT_ARGB555:
910 case V4L2_PIX_FMT_XRGB555:
911 case V4L2_PIX_FMT_RGB555:
912 case V4L2_PIX_FMT_ARGB555X:
913 case V4L2_PIX_FMT_XRGB555X:
914 case V4L2_PIX_FMT_RGB555X:
915 case V4L2_PIX_FMT_BGR666:
916 case V4L2_PIX_FMT_RGB565:
917 case V4L2_PIX_FMT_RGB565X:
918 case V4L2_PIX_FMT_RGB444:
919 case V4L2_PIX_FMT_Y4:
920 case V4L2_PIX_FMT_Y6:
921 case V4L2_PIX_FMT_Y10:
922 case V4L2_PIX_FMT_Y12:
923 case V4L2_PIX_FMT_Y10BPACK:
924 case V4L2_PIX_FMT_YUV555:
925 case V4L2_PIX_FMT_YUV565:
926 case V4L2_PIX_FMT_YUV32:
927 case V4L2_PIX_FMT_NV12MT_16X16:
928 case V4L2_PIX_FMT_NV42:
929 case V4L2_PIX_FMT_H264_MVC:
930 rank = RGB_ODD_BASE_RANK;
931 break;
932
933 case V4L2_PIX_FMT_RGB24:
934 case V4L2_PIX_FMT_BGR24:
935 rank = RGB_BASE_RANK - 1;
936 break;
937
938 case V4L2_PIX_FMT_RGB32:
939 case V4L2_PIX_FMT_BGR32:
940 case V4L2_PIX_FMT_ABGR32:
941 case V4L2_PIX_FMT_XBGR32:
942 case V4L2_PIX_FMT_ARGB32:
943 case V4L2_PIX_FMT_XRGB32:
944 rank = RGB_BASE_RANK;
945 break;
946
947 case V4L2_PIX_FMT_GREY: /* 8 Greyscale */
948 rank = GREY_BASE_RANK;
949 break;
950
951 case V4L2_PIX_FMT_NV12: /* 12 Y/CbCr 4:2:0 */
952 case V4L2_PIX_FMT_NV12M: /* Same as NV12 */
953 case V4L2_PIX_FMT_NV12MT: /* NV12 64x32 tile */
954 case V4L2_PIX_FMT_NV21: /* 12 Y/CrCb 4:2:0 */
955 case V4L2_PIX_FMT_NV21M: /* Same as NV21 */
956 case V4L2_PIX_FMT_YYUV: /* 16 YUV 4:2:2 */
957 case V4L2_PIX_FMT_HI240: /* 8 8-bit color */
958 case V4L2_PIX_FMT_NV16: /* 16 Y/CbCr 4:2:2 */
959 case V4L2_PIX_FMT_NV16M: /* Same as NV16 */
960 case V4L2_PIX_FMT_NV61: /* 16 Y/CrCb 4:2:2 */
961 case V4L2_PIX_FMT_NV61M: /* Same as NV61 */
962 case V4L2_PIX_FMT_NV24: /* 24 Y/CrCb 4:4:4 */
963 rank = YUV_ODD_BASE_RANK;
964 break;
965
966 case V4L2_PIX_FMT_YVU410: /* YVU9, 9 bits per pixel */
967 rank = YUV_BASE_RANK + 3;
968 break;
969 case V4L2_PIX_FMT_YUV410: /* YUV9, 9 bits per pixel */
970 rank = YUV_BASE_RANK + 2;
971 break;
972 case V4L2_PIX_FMT_YUV420: /* I420, 12 bits per pixel */
973 case V4L2_PIX_FMT_YUV420M:
974 rank = YUV_BASE_RANK + 7;
975 break;
976 case V4L2_PIX_FMT_YUYV: /* YUY2, 16 bits per pixel */
977 rank = YUV_BASE_RANK + 10;
978 break;
979 case V4L2_PIX_FMT_YVU420: /* YV12, 12 bits per pixel */
980 rank = YUV_BASE_RANK + 6;
981 break;
982 case V4L2_PIX_FMT_UYVY: /* UYVY, 16 bits per pixel */
983 rank = YUV_BASE_RANK + 9;
984 break;
985 case V4L2_PIX_FMT_YUV444:
986 rank = YUV_BASE_RANK + 6;
987 break;
988 case V4L2_PIX_FMT_Y41P: /* Y41P, 12 bits per pixel */
989 rank = YUV_BASE_RANK + 5;
990 break;
991 case V4L2_PIX_FMT_YUV411P: /* Y41B, 12 bits per pixel */
992 rank = YUV_BASE_RANK + 4;
993 break;
994 case V4L2_PIX_FMT_YUV422P: /* Y42B, 16 bits per pixel */
995 rank = YUV_BASE_RANK + 8;
996 break;
997
998 case V4L2_PIX_FMT_DV:
999 rank = DV_BASE_RANK;
1000 break;
1001
1002 case V4L2_PIX_FMT_WNVA: /* Winnov hw compres */
1003 rank = 0;
1004 break;
1005
1006 case V4L2_PIX_FMT_SBGGR8:
1007 case V4L2_PIX_FMT_SGBRG8:
1008 case V4L2_PIX_FMT_SGRBG8:
1009 case V4L2_PIX_FMT_SRGGB8:
1010 rank = BAYER_BASE_RANK;
1011 break;
1012
1013 case V4L2_PIX_FMT_SN9C10X:
1014 rank = S910_BASE_RANK;
1015 break;
1016
1017 case V4L2_PIX_FMT_PWC1:
1018 rank = PWC_BASE_RANK;
1019 break;
1020 case V4L2_PIX_FMT_PWC2:
1021 rank = PWC_BASE_RANK;
1022 break;
1023
1024 default:
1025 rank = 0;
1026 break;
1027 }
1028
1029 /* All ranks are below 1<<15 so a shift by 15
1030 * will a) make all non-emulated formats larger
1031 * than emulated and b) will not overflow
1032 */
1033 if (!emulated)
1034 rank <<= 15;
1035
1036 return rank;
1037}
1038
1039static gint
1040format_cmp_func(gconstpointer a, gconstpointer b)
1041{
1042 const struct v4l2_fmtdesc *fa = a;
1043 const struct v4l2_fmtdesc *fb = b;
1044
1045 if (fa->pixelformat == fb->pixelformat)
1046 return 0;
1047
1048 return gst_aml_v4l2_object_format_get_rank(fb) -
1049 gst_aml_v4l2_object_format_get_rank(fa);
1050}
1051
1052/******************************************************
1053 * gst_aml_v4l2_object_fill_format_list():
1054 * create list of supported capture formats
1055 * return value: TRUE on success, FALSE on error
1056 ******************************************************/
1057static gboolean
1058gst_aml_v4l2_object_fill_format_list(GstAmlV4l2Object *v4l2object,
1059 enum v4l2_buf_type type)
1060{
1061 gint n;
1062 struct v4l2_fmtdesc *format;
1063
1064 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "getting src format enumerations");
1065
1066 /* format enumeration */
1067 for (n = 0;; n++)
1068 {
1069 format = g_new0(struct v4l2_fmtdesc, 1);
1070
1071 format->index = n;
1072 format->type = type;
1073
1074 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_ENUM_FMT, format) < 0)
1075 {
1076 if (errno == EINVAL)
1077 {
1078 g_free(format);
1079 break; /* end of enumeration */
1080 }
1081 else
1082 {
1083 goto failed;
1084 }
1085 }
1086
1087 GST_LOG_OBJECT(v4l2object->dbg_obj, "index: %u", format->index);
1088 GST_LOG_OBJECT(v4l2object->dbg_obj, "type: %d", format->type);
1089 GST_LOG_OBJECT(v4l2object->dbg_obj, "flags: %08x", format->flags);
1090 GST_LOG_OBJECT(v4l2object->dbg_obj, "description: '%s'",
1091 format->description);
1092 GST_LOG_OBJECT(v4l2object->dbg_obj, "pixelformat: %" GST_FOURCC_FORMAT,
1093 GST_FOURCC_ARGS(format->pixelformat));
1094
1095 /* sort formats according to our preference; we do this, because caps
1096 * are probed in the order the formats are in the list, and the order of
1097 * formats in the final probed caps matters for things like fixation */
1098 v4l2object->formats = g_slist_insert_sorted(v4l2object->formats, format,
1099 (GCompareFunc)format_cmp_func);
1100 }
1101
1102#ifndef GST_DISABLE_GST_DEBUG
1103 {
1104 GSList *l;
1105
1106 GST_INFO_OBJECT(v4l2object->dbg_obj, "got %d format(s):", n);
1107 for (l = v4l2object->formats; l != NULL; l = l->next)
1108 {
1109 format = l->data;
1110
1111 GST_INFO_OBJECT(v4l2object->dbg_obj,
1112 " %" GST_FOURCC_FORMAT "%s", GST_FOURCC_ARGS(format->pixelformat),
1113 ((format->flags & V4L2_FMT_FLAG_EMULATED)) ? " (emulated)" : "");
1114 }
1115 }
1116#endif
1117
1118 return TRUE;
1119
1120 /* ERRORS */
1121failed:
1122{
1123 g_free(format);
1124
1125 if (v4l2object->element)
1126 return FALSE;
1127
1128 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, SETTINGS,
1129 (_("Failed to enumerate possible video formats device '%s' can work "
1130 "with"),
1131 v4l2object->videodev),
1132 ("Failed to get number %d in pixelformat enumeration for %s. (%d - %s)",
1133 n, v4l2object->videodev, errno, g_strerror(errno)));
1134
1135 return FALSE;
1136}
1137}
1138
1139/*
1140 * Get the list of supported capture formats, a list of
1141 * <code>struct v4l2_fmtdesc</code>.
1142 */
1143static GSList *
1144gst_aml_v4l2_object_get_format_list(GstAmlV4l2Object *v4l2object)
1145{
1146 if (!v4l2object->formats)
1147 {
1148
1149 /* check usual way */
1150 gst_aml_v4l2_object_fill_format_list(v4l2object, v4l2object->type);
1151
1152 /* if our driver supports multi-planar
1153 * and if formats are still empty then we can workaround driver bug
1154 * by also looking up formats as if our device was not supporting
1155 * multiplanar */
1156 if (!v4l2object->formats)
1157 {
1158 switch (v4l2object->type)
1159 {
1160 case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE:
1161 gst_aml_v4l2_object_fill_format_list(v4l2object,
1162 V4L2_BUF_TYPE_VIDEO_CAPTURE);
1163 break;
1164
1165 case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE:
1166 gst_aml_v4l2_object_fill_format_list(v4l2object,
1167 V4L2_BUF_TYPE_VIDEO_OUTPUT);
1168 break;
1169
1170 default:
1171 break;
1172 }
1173 }
1174 }
1175 return v4l2object->formats;
1176}
1177
1178static GstVideoFormat
1179gst_aml_v4l2_object_v4l2fourcc_to_video_format(guint32 fourcc)
1180{
1181 GstVideoFormat format;
1182
1183 switch (fourcc)
1184 {
1185 case V4L2_PIX_FMT_GREY: /* 8 Greyscale */
1186 format = GST_VIDEO_FORMAT_GRAY8;
1187 break;
1188 case V4L2_PIX_FMT_Y16:
1189 format = GST_VIDEO_FORMAT_GRAY16_LE;
1190 break;
1191 case V4L2_PIX_FMT_Y16_BE:
1192 format = GST_VIDEO_FORMAT_GRAY16_BE;
1193 break;
1194 case V4L2_PIX_FMT_XRGB555:
1195 case V4L2_PIX_FMT_RGB555:
1196 format = GST_VIDEO_FORMAT_RGB15;
1197 break;
1198 case V4L2_PIX_FMT_XRGB555X:
1199 case V4L2_PIX_FMT_RGB555X:
1200 format = GST_VIDEO_FORMAT_BGR15;
1201 break;
1202 case V4L2_PIX_FMT_RGB565:
1203 format = GST_VIDEO_FORMAT_RGB16;
1204 break;
1205 case V4L2_PIX_FMT_RGB24:
1206 format = GST_VIDEO_FORMAT_RGB;
1207 break;
1208 case V4L2_PIX_FMT_BGR24:
1209 format = GST_VIDEO_FORMAT_BGR;
1210 break;
1211 case V4L2_PIX_FMT_XRGB32:
1212 case V4L2_PIX_FMT_RGB32:
1213 format = GST_VIDEO_FORMAT_xRGB;
1214 break;
1215 case V4L2_PIX_FMT_XBGR32:
1216 case V4L2_PIX_FMT_BGR32:
1217 format = GST_VIDEO_FORMAT_BGRx;
1218 break;
1219 case V4L2_PIX_FMT_ABGR32:
1220 format = GST_VIDEO_FORMAT_BGRA;
1221 break;
1222 case V4L2_PIX_FMT_ARGB32:
1223 format = GST_VIDEO_FORMAT_ARGB;
1224 break;
1225 case V4L2_PIX_FMT_NV12:
1226 case V4L2_PIX_FMT_NV12M:
1227 format = GST_VIDEO_FORMAT_NV12;
1228 break;
1229 case V4L2_PIX_FMT_NV12MT:
1230 format = GST_VIDEO_FORMAT_NV12_64Z32;
1231 break;
1232 case V4L2_PIX_FMT_NV21:
1233 case V4L2_PIX_FMT_NV21M:
1234 format = GST_VIDEO_FORMAT_NV21;
1235 break;
1236 case V4L2_PIX_FMT_YVU410:
1237 format = GST_VIDEO_FORMAT_YVU9;
1238 break;
1239 case V4L2_PIX_FMT_YUV410:
1240 format = GST_VIDEO_FORMAT_YUV9;
1241 break;
1242 case V4L2_PIX_FMT_YUV420:
1243 case V4L2_PIX_FMT_YUV420M:
1244 format = GST_VIDEO_FORMAT_I420;
1245 break;
1246 case V4L2_PIX_FMT_YUYV:
1247 format = GST_VIDEO_FORMAT_YUY2;
1248 break;
1249 case V4L2_PIX_FMT_YVU420:
1250 format = GST_VIDEO_FORMAT_YV12;
1251 break;
1252 case V4L2_PIX_FMT_UYVY:
1253 format = GST_VIDEO_FORMAT_UYVY;
1254 break;
1255 case V4L2_PIX_FMT_YUV411P:
1256 format = GST_VIDEO_FORMAT_Y41B;
1257 break;
1258 case V4L2_PIX_FMT_YUV422P:
1259 format = GST_VIDEO_FORMAT_Y42B;
1260 break;
1261 case V4L2_PIX_FMT_YVYU:
1262 format = GST_VIDEO_FORMAT_YVYU;
1263 break;
1264 case V4L2_PIX_FMT_NV16:
1265 case V4L2_PIX_FMT_NV16M:
1266 format = GST_VIDEO_FORMAT_NV16;
1267 break;
1268 case V4L2_PIX_FMT_NV61:
1269 case V4L2_PIX_FMT_NV61M:
1270 format = GST_VIDEO_FORMAT_NV61;
1271 break;
1272 case V4L2_PIX_FMT_NV24:
1273 format = GST_VIDEO_FORMAT_NV24;
1274 break;
1275 default:
1276 format = GST_VIDEO_FORMAT_UNKNOWN;
1277 break;
1278 }
1279
1280 return format;
1281}
1282
1283static gboolean
1284gst_amL_v4l2_object_v4l2fourcc_is_rgb(guint32 fourcc)
1285{
1286 gboolean ret = FALSE;
1287
1288 switch (fourcc)
1289 {
1290 case V4L2_PIX_FMT_XRGB555:
1291 case V4L2_PIX_FMT_RGB555:
1292 case V4L2_PIX_FMT_XRGB555X:
1293 case V4L2_PIX_FMT_RGB555X:
1294 case V4L2_PIX_FMT_RGB565:
1295 case V4L2_PIX_FMT_RGB24:
1296 case V4L2_PIX_FMT_BGR24:
1297 case V4L2_PIX_FMT_XRGB32:
1298 case V4L2_PIX_FMT_RGB32:
1299 case V4L2_PIX_FMT_XBGR32:
1300 case V4L2_PIX_FMT_BGR32:
1301 case V4L2_PIX_FMT_ABGR32:
1302 case V4L2_PIX_FMT_ARGB32:
1303 case V4L2_PIX_FMT_SBGGR8:
1304 case V4L2_PIX_FMT_SGBRG8:
1305 case V4L2_PIX_FMT_SGRBG8:
1306 case V4L2_PIX_FMT_SRGGB8:
1307 ret = TRUE;
1308 break;
1309 default:
1310 break;
1311 }
1312
1313 return ret;
1314}
1315
1316static GstStructure *
1317gst_aml_v4l2_object_v4l2fourcc_to_bare_struct(guint32 fourcc)
1318{
1319 GstStructure *structure = NULL;
1320
1321 switch (fourcc)
1322 {
1323 case V4L2_PIX_FMT_MJPEG: /* Motion-JPEG */
1324 case V4L2_PIX_FMT_PJPG: /* Progressive-JPEG */
1325 case V4L2_PIX_FMT_JPEG: /* JFIF JPEG */
1326 structure = gst_structure_new_empty("image/jpeg");
1327 break;
1328 case V4L2_PIX_FMT_MPEG1:
1329 structure = gst_structure_new("video/mpeg",
1330 "mpegversion", G_TYPE_INT, 1, NULL);
1331 break;
1332 case V4L2_PIX_FMT_MPEG2:
1333 structure = gst_structure_new("video/mpeg",
1334 "mpegversion", G_TYPE_INT, 2, NULL);
1335 gst_structure_set(structure, "systemstream", G_TYPE_BOOLEAN, FALSE, NULL);
1336 GST_DEBUG("aml set mpeg2 systemstream to false");
1337 break;
1338 case V4L2_PIX_FMT_MPEG4:
1339 case V4L2_PIX_FMT_XVID:
1340 structure = gst_structure_new("video/mpeg",
1341 "mpegversion", G_TYPE_INT, 4, "systemstream",
1342 G_TYPE_BOOLEAN, FALSE, NULL);
1343 break;
1344 case V4L2_PIX_FMT_FWHT:
1345 structure = gst_structure_new_empty("video/x-fwht");
1346 break;
1347 case V4L2_PIX_FMT_H263:
1348 structure = gst_structure_new("video/x-h263",
1349 "variant", G_TYPE_STRING, "itu", NULL);
1350 break;
1351 case V4L2_PIX_FMT_H264: /* H.264 */
1352 structure = gst_structure_new("video/x-h264",
1353 "stream-format", G_TYPE_STRING, "byte-stream", "alignment",
1354 G_TYPE_STRING, "au", NULL);
1355 break;
1356 case V4L2_PIX_FMT_H264_NO_SC:
1357 structure = gst_structure_new("video/x-h264",
1358 "stream-format", G_TYPE_STRING, "avc", "alignment",
1359 G_TYPE_STRING, "au", NULL);
1360 break;
1361 case V4L2_PIX_FMT_HEVC: /* H.265 */
1362 structure = gst_structure_new("video/x-h265",
1363 "stream-format", G_TYPE_STRING, "byte-stream", "alignment",
1364 G_TYPE_STRING, "au", NULL);
1365 break;
1366 case V4L2_PIX_FMT_VC1_ANNEX_G:
1367 case V4L2_PIX_FMT_VC1_ANNEX_L:
1368 structure = gst_structure_new("video/x-wmv",
1369 "wmvversion", G_TYPE_INT, 3, "format", G_TYPE_STRING, "WVC1", NULL);
1370 break;
1371 case V4L2_PIX_FMT_VP8:
1372 structure = gst_structure_new_empty("video/x-vp8");
1373 break;
1374 case V4L2_PIX_FMT_VP9:
1375 structure = gst_structure_new_empty("video/x-vp9");
1376 break;
1377 case V4L2_PIX_FMT_AV1:
1378 structure = gst_structure_new_empty("video/x-av1");
1379 break;
1380 case V4L2_PIX_FMT_GREY: /* 8 Greyscale */
1381 case V4L2_PIX_FMT_Y16:
1382 case V4L2_PIX_FMT_Y16_BE:
1383 case V4L2_PIX_FMT_XRGB555:
1384 case V4L2_PIX_FMT_RGB555:
1385 case V4L2_PIX_FMT_XRGB555X:
1386 case V4L2_PIX_FMT_RGB555X:
1387 case V4L2_PIX_FMT_RGB565:
1388 case V4L2_PIX_FMT_RGB24:
1389 case V4L2_PIX_FMT_BGR24:
1390 case V4L2_PIX_FMT_RGB32:
1391 case V4L2_PIX_FMT_XRGB32:
1392 case V4L2_PIX_FMT_ARGB32:
1393 case V4L2_PIX_FMT_BGR32:
1394 case V4L2_PIX_FMT_XBGR32:
1395 case V4L2_PIX_FMT_ABGR32:
1396 case V4L2_PIX_FMT_NV12: /* 12 Y/CbCr 4:2:0 */
1397 case V4L2_PIX_FMT_NV12M:
1398 case V4L2_PIX_FMT_NV12MT:
1399 case V4L2_PIX_FMT_NV21: /* 12 Y/CrCb 4:2:0 */
1400 case V4L2_PIX_FMT_NV21M:
1401 case V4L2_PIX_FMT_NV16: /* 16 Y/CbCr 4:2:2 */
1402 case V4L2_PIX_FMT_NV16M:
1403 case V4L2_PIX_FMT_NV61: /* 16 Y/CrCb 4:2:2 */
1404 case V4L2_PIX_FMT_NV61M:
1405 case V4L2_PIX_FMT_NV24: /* 24 Y/CrCb 4:4:4 */
1406 case V4L2_PIX_FMT_YVU410:
1407 case V4L2_PIX_FMT_YUV410:
1408 case V4L2_PIX_FMT_YUV420: /* I420/IYUV */
1409 case V4L2_PIX_FMT_YUV420M:
1410 case V4L2_PIX_FMT_YUYV:
1411 case V4L2_PIX_FMT_YVU420:
1412 case V4L2_PIX_FMT_UYVY:
1413 case V4L2_PIX_FMT_YUV422P:
1414 case V4L2_PIX_FMT_YVYU:
1415 case V4L2_PIX_FMT_YUV411P:
1416 {
1417 GstVideoFormat format;
1418 format = gst_aml_v4l2_object_v4l2fourcc_to_video_format(fourcc);
1419 if (format != GST_VIDEO_FORMAT_UNKNOWN)
1420 structure = gst_structure_new("video/x-raw",
1421 "format", G_TYPE_STRING, gst_video_format_to_string(format), NULL);
1422 break;
1423 }
1424 case V4L2_PIX_FMT_DV:
1425 structure =
1426 gst_structure_new("video/x-dv", "systemstream", G_TYPE_BOOLEAN, TRUE,
1427 NULL);
1428 break;
1429 case V4L2_PIX_FMT_MPEG: /* MPEG */
1430 structure = gst_structure_new("video/mpegts",
1431 "systemstream", G_TYPE_BOOLEAN, TRUE, NULL);
1432 break;
1433 case V4L2_PIX_FMT_WNVA: /* Winnov hw compres */
1434 break;
1435 case V4L2_PIX_FMT_SBGGR8:
1436 case V4L2_PIX_FMT_SGBRG8:
1437 case V4L2_PIX_FMT_SGRBG8:
1438 case V4L2_PIX_FMT_SRGGB8:
1439 structure = gst_structure_new("video/x-bayer", "format", G_TYPE_STRING,
1440 fourcc == V4L2_PIX_FMT_SBGGR8 ? "bggr" : fourcc == V4L2_PIX_FMT_SGBRG8 ? "gbrg"
1441 : fourcc == V4L2_PIX_FMT_SGRBG8 ? "grbg"
1442 :
1443 /* fourcc == V4L2_PIX_FMT_SRGGB8 ? */ "rggb",
1444 NULL);
1445 break;
1446 case V4L2_PIX_FMT_SN9C10X:
1447 structure = gst_structure_new_empty("video/x-sonix");
1448 break;
1449 case V4L2_PIX_FMT_PWC1:
1450 structure = gst_structure_new_empty("video/x-pwc1");
1451 break;
1452 case V4L2_PIX_FMT_PWC2:
1453 structure = gst_structure_new_empty("video/x-pwc2");
1454 break;
1455 case V4L2_PIX_FMT_RGB332:
1456 case V4L2_PIX_FMT_BGR666:
1457 case V4L2_PIX_FMT_ARGB555X:
1458 case V4L2_PIX_FMT_RGB565X:
1459 case V4L2_PIX_FMT_RGB444:
1460 case V4L2_PIX_FMT_YYUV: /* 16 YUV 4:2:2 */
1461 case V4L2_PIX_FMT_HI240: /* 8 8-bit color */
1462 case V4L2_PIX_FMT_Y4:
1463 case V4L2_PIX_FMT_Y6:
1464 case V4L2_PIX_FMT_Y10:
1465 case V4L2_PIX_FMT_Y12:
1466 case V4L2_PIX_FMT_Y10BPACK:
1467 case V4L2_PIX_FMT_YUV444:
1468 case V4L2_PIX_FMT_YUV555:
1469 case V4L2_PIX_FMT_YUV565:
1470 case V4L2_PIX_FMT_Y41P:
1471 case V4L2_PIX_FMT_YUV32:
1472 case V4L2_PIX_FMT_NV12MT_16X16:
1473 case V4L2_PIX_FMT_NV42:
1474 case V4L2_PIX_FMT_H264_MVC:
1475 default:
1476 GST_DEBUG("Unsupported fourcc 0x%08x %" GST_FOURCC_FORMAT,
1477 fourcc, GST_FOURCC_ARGS(fourcc));
1478 break;
1479 }
1480
1481 return structure;
1482}
1483
1484GstStructure *
1485gst_aml_v4l2_object_v4l2fourcc_to_structure(guint32 fourcc)
1486{
1487 GstStructure *template;
1488 gint i;
1489
1490 template = gst_aml_v4l2_object_v4l2fourcc_to_bare_struct(fourcc);
1491
1492 if (template == NULL)
1493 goto done;
1494
1495 for (i = 0; i < GST_AML_V4L2_FORMAT_COUNT; i++)
1496 {
1497 if (gst_aml_v4l2_formats[i].format != fourcc)
1498 continue;
1499
1500 if (gst_aml_v4l2_formats[i].dimensions)
1501 {
1502 gst_structure_set(template,
1503 "width", GST_TYPE_INT_RANGE, 1, GST_AML_V4L2_MAX_SIZE,
1504 "height", GST_TYPE_INT_RANGE, 1, GST_AML_V4L2_MAX_SIZE,
1505 "framerate", GST_TYPE_FRACTION_RANGE, 0, 1, G_MAXINT, 1, NULL);
1506 }
1507 break;
1508 }
1509
1510done:
1511 return template;
1512}
1513
1514static GstCaps *
1515gst_aml_v4l2_object_get_caps_helper(GstAmlV4L2FormatFlags flags)
1516{
1517 GstStructure *structure;
1518 GstCaps *caps;
1519 guint i;
1520
1521 caps = gst_caps_new_empty();
1522 for (i = 0; i < GST_AML_V4L2_FORMAT_COUNT; i++)
1523 {
1524
1525 if ((gst_aml_v4l2_formats[i].flags & flags) == 0)
1526 continue;
1527
1528 structure =
1529 gst_aml_v4l2_object_v4l2fourcc_to_bare_struct(gst_aml_v4l2_formats[i].format);
1530
1531 if (structure)
1532 {
1533 GstStructure *alt_s = NULL;
1534
1535 if (gst_aml_v4l2_formats[i].dimensions)
1536 {
1537 gst_structure_set(structure,
1538 "width", GST_TYPE_INT_RANGE, 1, GST_AML_V4L2_MAX_SIZE,
1539 "height", GST_TYPE_INT_RANGE, 1, GST_AML_V4L2_MAX_SIZE,
1540 "framerate", GST_TYPE_FRACTION_RANGE, 0, 1, G_MAXINT, 1, NULL);
1541 }
1542
1543 switch (gst_aml_v4l2_formats[i].format)
1544 {
1545 case V4L2_PIX_FMT_RGB32:
1546 alt_s = gst_structure_copy(structure);
1547 gst_structure_set(alt_s, "format", G_TYPE_STRING, "ARGB", NULL);
1548 break;
1549 case V4L2_PIX_FMT_BGR32:
1550 alt_s = gst_structure_copy(structure);
1551 gst_structure_set(alt_s, "format", G_TYPE_STRING, "BGRA", NULL);
1552 default:
1553 break;
1554 }
1555
1556 gst_caps_append_structure(caps, structure);
1557
1558 if (alt_s)
1559 gst_caps_append_structure(caps, alt_s);
1560 }
1561 }
1562
1563 return gst_caps_simplify(caps);
1564}
1565
1566GstCaps *
1567gst_aml_v4l2_object_get_all_caps(void)
1568{
1569 static GstCaps *caps = NULL;
1570
1571 if (g_once_init_enter(&caps))
1572 {
1573 GstCaps *all_caps = gst_aml_v4l2_object_get_caps_helper(GST_V4L2_ALL);
1574 GST_MINI_OBJECT_FLAG_SET(all_caps, GST_MINI_OBJECT_FLAG_MAY_BE_LEAKED);
1575 g_once_init_leave(&caps, all_caps);
1576 }
1577
1578 return caps;
1579}
1580
1581GstCaps *
1582gst_aml_v4l2_object_get_raw_caps(void)
1583{
1584 static GstCaps *caps = NULL;
1585
1586 if (g_once_init_enter(&caps))
1587 {
1588 GstCaps *raw_caps = gst_aml_v4l2_object_get_caps_helper(GST_V4L2_RAW);
1589 GST_MINI_OBJECT_FLAG_SET(raw_caps, GST_MINI_OBJECT_FLAG_MAY_BE_LEAKED);
1590 g_once_init_leave(&caps, raw_caps);
1591 }
1592
1593 return caps;
1594}
1595
1596GstCaps *
1597gst_aml_v4l2_object_get_codec_caps(void)
1598{
1599 static GstCaps *caps = NULL;
1600
1601 if (g_once_init_enter(&caps))
1602 {
1603 GstCaps *codec_caps = gst_aml_v4l2_object_get_caps_helper(GST_V4L2_CODEC);
1604 GST_MINI_OBJECT_FLAG_SET(codec_caps, GST_MINI_OBJECT_FLAG_MAY_BE_LEAKED);
1605 g_once_init_leave(&caps, codec_caps);
1606 }
1607
1608 return caps;
1609}
1610
1611/* collect data for the given caps
1612 * @caps: given input caps
1613 * @format: location for the v4l format
1614 * @w/@h: location for width and height
1615 * @fps_n/@fps_d: location for framerate
1616 * @size: location for expected size of the frame or 0 if unknown
1617 */
1618static gboolean
1619gst_aml_v4l2_object_get_caps_info(GstAmlV4l2Object *v4l2object, GstCaps *caps,
1620 struct v4l2_fmtdesc **format, GstVideoInfo *info)
1621{
1622 GstStructure *structure;
1623 guint32 fourcc = 0, fourcc_nc = 0;
1624 const gchar *mimetype;
1625 struct v4l2_fmtdesc *fmt = NULL;
1626
1627 structure = gst_caps_get_structure(caps, 0);
1628
1629 mimetype = gst_structure_get_name(structure);
1630
1631 if (!gst_video_info_from_caps(info, caps))
1632 goto invalid_format;
1633
1634 if (g_str_equal(mimetype, "video/x-raw"))
1635 {
1636 switch (GST_VIDEO_INFO_FORMAT(info))
1637 {
1638 case GST_VIDEO_FORMAT_I420:
1639 fourcc = V4L2_PIX_FMT_YUV420;
1640 fourcc_nc = V4L2_PIX_FMT_YUV420M;
1641 break;
1642 case GST_VIDEO_FORMAT_YUY2:
1643 fourcc = V4L2_PIX_FMT_YUYV;
1644 break;
1645 case GST_VIDEO_FORMAT_UYVY:
1646 fourcc = V4L2_PIX_FMT_UYVY;
1647 break;
1648 case GST_VIDEO_FORMAT_YV12:
1649 fourcc = V4L2_PIX_FMT_YVU420;
1650 break;
1651 case GST_VIDEO_FORMAT_Y41B:
1652 fourcc = V4L2_PIX_FMT_YUV411P;
1653 break;
1654 case GST_VIDEO_FORMAT_Y42B:
1655 fourcc = V4L2_PIX_FMT_YUV422P;
1656 break;
1657 case GST_VIDEO_FORMAT_NV12:
1658 fourcc = V4L2_PIX_FMT_NV12;
1659 fourcc_nc = V4L2_PIX_FMT_NV12M;
1660 break;
1661 case GST_VIDEO_FORMAT_NV12_64Z32:
1662 fourcc_nc = V4L2_PIX_FMT_NV12MT;
1663 break;
1664 case GST_VIDEO_FORMAT_NV21:
1665 fourcc = V4L2_PIX_FMT_NV21;
1666 fourcc_nc = V4L2_PIX_FMT_NV21M;
1667 break;
1668 case GST_VIDEO_FORMAT_NV16:
1669 fourcc = V4L2_PIX_FMT_NV16;
1670 fourcc_nc = V4L2_PIX_FMT_NV16M;
1671 break;
1672 case GST_VIDEO_FORMAT_NV61:
1673 fourcc = V4L2_PIX_FMT_NV61;
1674 fourcc_nc = V4L2_PIX_FMT_NV61M;
1675 break;
1676 case GST_VIDEO_FORMAT_NV24:
1677 fourcc = V4L2_PIX_FMT_NV24;
1678 break;
1679 case GST_VIDEO_FORMAT_YVYU:
1680 fourcc = V4L2_PIX_FMT_YVYU;
1681 break;
1682 case GST_VIDEO_FORMAT_RGB15:
1683 fourcc = V4L2_PIX_FMT_RGB555;
1684 fourcc_nc = V4L2_PIX_FMT_XRGB555;
1685 break;
1686 case GST_VIDEO_FORMAT_RGB16:
1687 fourcc = V4L2_PIX_FMT_RGB565;
1688 break;
1689 case GST_VIDEO_FORMAT_RGB:
1690 fourcc = V4L2_PIX_FMT_RGB24;
1691 break;
1692 case GST_VIDEO_FORMAT_BGR:
1693 fourcc = V4L2_PIX_FMT_BGR24;
1694 break;
1695 case GST_VIDEO_FORMAT_xRGB:
1696 fourcc = V4L2_PIX_FMT_RGB32;
1697 fourcc_nc = V4L2_PIX_FMT_XRGB32;
1698 break;
1699 case GST_VIDEO_FORMAT_ARGB:
1700 fourcc = V4L2_PIX_FMT_RGB32;
1701 fourcc_nc = V4L2_PIX_FMT_ARGB32;
1702 break;
1703 case GST_VIDEO_FORMAT_BGRx:
1704 fourcc = V4L2_PIX_FMT_BGR32;
1705 fourcc_nc = V4L2_PIX_FMT_XBGR32;
1706 break;
1707 case GST_VIDEO_FORMAT_BGRA:
1708 fourcc = V4L2_PIX_FMT_BGR32;
1709 fourcc_nc = V4L2_PIX_FMT_ABGR32;
1710 break;
1711 case GST_VIDEO_FORMAT_GRAY8:
1712 fourcc = V4L2_PIX_FMT_GREY;
1713 break;
1714 case GST_VIDEO_FORMAT_GRAY16_LE:
1715 fourcc = V4L2_PIX_FMT_Y16;
1716 break;
1717 case GST_VIDEO_FORMAT_GRAY16_BE:
1718 fourcc = V4L2_PIX_FMT_Y16_BE;
1719 break;
1720 case GST_VIDEO_FORMAT_BGR15:
1721 fourcc = V4L2_PIX_FMT_RGB555X;
1722 fourcc_nc = V4L2_PIX_FMT_XRGB555X;
1723 break;
1724 default:
1725 break;
1726 }
1727 }
1728 else
1729 {
1730 if (g_str_equal(mimetype, "video/mpegts"))
1731 {
1732 fourcc = V4L2_PIX_FMT_MPEG;
1733 }
1734 else if (g_str_equal(mimetype, "video/x-dv"))
1735 {
1736 fourcc = V4L2_PIX_FMT_DV;
1737 }
1738 else if (g_str_equal(mimetype, "image/jpeg"))
1739 {
1740 fourcc = V4L2_PIX_FMT_JPEG;
1741 }
1742 else if (g_str_equal(mimetype, "video/mpeg"))
1743 {
1744 gint version;
1745 if (gst_structure_get_int(structure, "mpegversion", &version))
1746 {
1747 switch (version)
1748 {
1749 case 1:
1750 fourcc = V4L2_PIX_FMT_MPEG1;
1751 break;
1752 case 2:
1753 fourcc = V4L2_PIX_FMT_MPEG2;
1754 break;
1755 case 4:
1756 fourcc = V4L2_PIX_FMT_MPEG4;
1757 fourcc_nc = V4L2_PIX_FMT_XVID;
1758 break;
1759 default:
1760 break;
1761 }
1762 }
1763 }
1764 else if (g_str_equal(mimetype, "video/x-fwht"))
1765 {
1766 fourcc = V4L2_PIX_FMT_FWHT;
1767 }
1768 else if (g_str_equal(mimetype, "video/x-h263"))
1769 {
1770 fourcc = V4L2_PIX_FMT_H263;
1771 }
1772 else if (g_str_equal(mimetype, "video/x-h264"))
1773 {
1774 const gchar *stream_format =
1775 gst_structure_get_string(structure, "stream-format");
1776 if (g_str_equal(stream_format, "avc"))
1777 fourcc = V4L2_PIX_FMT_H264_NO_SC;
1778 else
1779 fourcc = V4L2_PIX_FMT_H264;
1780 }
1781 else if (g_str_equal(mimetype, "video/x-h265"))
1782 {
1783 fourcc = V4L2_PIX_FMT_HEVC;
1784 }
1785 else if (g_str_equal(mimetype, "video/x-vp8"))
1786 {
1787 fourcc = V4L2_PIX_FMT_VP8;
1788 }
1789 else if (g_str_equal(mimetype, "video/x-vp9"))
1790 {
1791 fourcc = V4L2_PIX_FMT_VP9;
1792 }
1793 else if (g_str_equal(mimetype, "video/x-av1"))
1794 {
1795 fourcc = V4L2_PIX_FMT_AV1;
1796 }
1797 else if (g_str_equal(mimetype, "video/x-bayer"))
1798 {
1799 const gchar *format = gst_structure_get_string(structure, "format");
1800 if (format)
1801 {
1802 if (!g_ascii_strcasecmp(format, "bggr"))
1803 fourcc = V4L2_PIX_FMT_SBGGR8;
1804 else if (!g_ascii_strcasecmp(format, "gbrg"))
1805 fourcc = V4L2_PIX_FMT_SGBRG8;
1806 else if (!g_ascii_strcasecmp(format, "grbg"))
1807 fourcc = V4L2_PIX_FMT_SGRBG8;
1808 else if (!g_ascii_strcasecmp(format, "rggb"))
1809 fourcc = V4L2_PIX_FMT_SRGGB8;
1810 }
1811 }
1812 else if (g_str_equal(mimetype, "video/x-sonix"))
1813 {
1814 fourcc = V4L2_PIX_FMT_SN9C10X;
1815 }
1816 else if (g_str_equal(mimetype, "video/x-pwc1"))
1817 {
1818 fourcc = V4L2_PIX_FMT_PWC1;
1819 }
1820 else if (g_str_equal(mimetype, "video/x-pwc2"))
1821 {
1822 fourcc = V4L2_PIX_FMT_PWC2;
1823 }
1824 }
1825
1826 /* Prefer the non-contiguous if supported */
1827 v4l2object->prefered_non_contiguous = TRUE;
1828
1829 if (fourcc_nc)
1830 fmt = gst_aml_v4l2_object_get_format_from_fourcc(v4l2object, fourcc_nc);
1831 else if (fourcc == 0)
1832 goto unhandled_format;
1833
1834 if (fmt == NULL)
1835 {
1836 fmt = gst_aml_v4l2_object_get_format_from_fourcc(v4l2object, fourcc);
1837 v4l2object->prefered_non_contiguous = FALSE;
1838 }
1839
1840 if (fmt == NULL)
1841 goto unsupported_format;
1842
1843 *format = fmt;
1844
1845 return TRUE;
1846
1847 /* ERRORS */
1848invalid_format:
1849{
1850 GST_DEBUG_OBJECT(v4l2object, "invalid format");
1851 return FALSE;
1852}
1853unhandled_format:
1854{
1855 GST_DEBUG_OBJECT(v4l2object, "unhandled format");
1856 return FALSE;
1857}
1858unsupported_format:
1859{
1860 GST_DEBUG_OBJECT(v4l2object, "unsupported format");
1861 return FALSE;
1862}
1863}
1864
1865static gboolean
1866gst_aml_v4l2_object_get_nearest_size(GstAmlV4l2Object *v4l2object,
1867 guint32 pixelformat, gint *width, gint *height);
1868
1869static void
1870gst_aml_v4l2_object_add_aspect_ratio(GstAmlV4l2Object *v4l2object, GstStructure *s)
1871{
1872 if (v4l2object->keep_aspect && v4l2object->par)
1873 gst_structure_set_value(s, "pixel-aspect-ratio", v4l2object->par);
1874}
1875
1876/* returns TRUE if the value was changed in place, otherwise FALSE */
1877static gboolean
1878gst_aml_v4l2src_value_simplify(GValue *val)
1879{
1880 /* simplify list of one value to one value */
1881 if (GST_VALUE_HOLDS_LIST(val) && gst_value_list_get_size(val) == 1)
1882 {
1883 const GValue *list_val;
1884 GValue new_val = G_VALUE_INIT;
1885
1886 list_val = gst_value_list_get_value(val, 0);
1887 g_value_init(&new_val, G_VALUE_TYPE(list_val));
1888 g_value_copy(list_val, &new_val);
1889 g_value_unset(val);
1890 *val = new_val;
1891 return TRUE;
1892 }
1893
1894 return FALSE;
1895}
1896
1897static gboolean
1898gst_aml_v4l2_object_get_interlace_mode(enum v4l2_field field,
1899 GstVideoInterlaceMode *interlace_mode)
1900{
1901 switch (field)
1902 {
1903 case V4L2_FIELD_ANY:
1904 GST_ERROR("Driver bug detected - check driver with v4l2-compliance from http://git.linuxtv.org/v4l-utils.git\n");
1905 /* fallthrough */
1906 case V4L2_FIELD_NONE:
1907 *interlace_mode = GST_VIDEO_INTERLACE_MODE_PROGRESSIVE;
1908 return TRUE;
1909 case V4L2_FIELD_INTERLACED:
1910 case V4L2_FIELD_INTERLACED_TB:
1911 case V4L2_FIELD_INTERLACED_BT:
1912 *interlace_mode = GST_VIDEO_INTERLACE_MODE_INTERLEAVED;
1913 return TRUE;
1914 default:
1915 GST_ERROR("Unknown enum v4l2_field %d", field);
1916 return FALSE;
1917 }
1918}
1919
1920static gboolean
1921gst_aml_v4l2_object_get_colorspace(struct v4l2_format *fmt,
1922 GstVideoColorimetry *cinfo)
1923{
1924 gboolean is_rgb =
1925 gst_amL_v4l2_object_v4l2fourcc_is_rgb(fmt->fmt.pix.pixelformat);
1926 enum v4l2_colorspace colorspace;
1927 enum v4l2_quantization range;
1928 enum v4l2_ycbcr_encoding matrix;
1929 enum v4l2_xfer_func transfer;
1930 gboolean ret = TRUE;
1931
1932 if (V4L2_TYPE_IS_MULTIPLANAR(fmt->type))
1933 {
1934 colorspace = fmt->fmt.pix_mp.colorspace;
1935 range = fmt->fmt.pix_mp.quantization;
1936 matrix = fmt->fmt.pix_mp.ycbcr_enc;
1937 transfer = fmt->fmt.pix_mp.xfer_func;
1938 }
1939 else
1940 {
1941 colorspace = fmt->fmt.pix.colorspace;
1942 range = fmt->fmt.pix.quantization;
1943 matrix = fmt->fmt.pix.ycbcr_enc;
1944 transfer = fmt->fmt.pix.xfer_func;
1945 }
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]1946 GST_DEBUG("colorspace:%d, range:%d, matrix:%d, transfer:%d", colorspace, range, matrix, transfer);
1947 GST_DEBUG("cinfo update 1 time | range:%d, matrix:%d, transfer:%d, primaries:%d", cinfo->range, cinfo->matrix, cinfo->transfer, cinfo->primaries);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]1948
1949 /* First step, set the defaults for each primaries */
1950 switch (colorspace)
1951 {
1952 case V4L2_COLORSPACE_SMPTE170M:
1953 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
1954 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
1955 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
1956 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_SMPTE170M;
1957 break;
1958 case V4L2_COLORSPACE_REC709:
1959 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
1960 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT709;
1961 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
1962 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT709;
1963 break;
1964 case V4L2_COLORSPACE_SRGB:
1965 case V4L2_COLORSPACE_JPEG:
1966 cinfo->range = GST_VIDEO_COLOR_RANGE_0_255;
1967 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
1968 cinfo->transfer = GST_VIDEO_TRANSFER_SRGB;
1969 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT709;
1970 break;
1971 case V4L2_COLORSPACE_OPRGB:
1972 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
1973 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
1974 cinfo->transfer = GST_VIDEO_TRANSFER_ADOBERGB;
1975 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_ADOBERGB;
1976 break;
1977 case V4L2_COLORSPACE_BT2020:
1978 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
1979 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT2020;
1980 cinfo->transfer = GST_VIDEO_TRANSFER_BT2020_12;
1981 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT2020;
1982 break;
1983 case V4L2_COLORSPACE_SMPTE240M:
1984 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
1985 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_SMPTE240M;
1986 cinfo->transfer = GST_VIDEO_TRANSFER_SMPTE240M;
1987 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_SMPTE240M;
1988 break;
1989 case V4L2_COLORSPACE_470_SYSTEM_M:
1990 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
1991 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
1992 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
1993 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT470M;
1994 break;
1995 case V4L2_COLORSPACE_470_SYSTEM_BG:
1996 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
1997 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
1998 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
1999 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT470BG;
2000 break;
2001 case V4L2_COLORSPACE_RAW:
2002 /* Explicitly unknown */
2003 cinfo->range = GST_VIDEO_COLOR_RANGE_UNKNOWN;
2004 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_UNKNOWN;
2005 cinfo->transfer = GST_VIDEO_TRANSFER_UNKNOWN;
2006 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_UNKNOWN;
2007 break;
2008 default:
2009 GST_DEBUG("Unknown enum v4l2_colorspace %d", colorspace);
2010 ret = FALSE;
2011 break;
2012 }
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]2013 GST_DEBUG("cinfo update 2 time | range:%d, matrix:%d, transfer:%d, primaries:%d", cinfo->range, cinfo->matrix, cinfo->transfer, cinfo->primaries);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]2014
2015 if (!ret)
2016 goto done;
2017
2018 /* Second step, apply any custom variation */
2019 switch (range)
2020 {
2021 case V4L2_QUANTIZATION_FULL_RANGE:
2022 cinfo->range = GST_VIDEO_COLOR_RANGE_0_255;
2023 break;
2024 case V4L2_QUANTIZATION_LIM_RANGE:
2025 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2026 break;
2027 case V4L2_QUANTIZATION_DEFAULT:
2028 /* replicated V4L2_MAP_QUANTIZATION_DEFAULT macro behavior */
2029 if (is_rgb && colorspace == V4L2_COLORSPACE_BT2020)
2030 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2031 else if (is_rgb || matrix == V4L2_YCBCR_ENC_XV601 || matrix == V4L2_YCBCR_ENC_XV709 || colorspace == V4L2_COLORSPACE_JPEG)
2032 cinfo->range = GST_VIDEO_COLOR_RANGE_0_255;
2033 else
2034 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2035 break;
2036 default:
2037 GST_WARNING("Unknown enum v4l2_quantization value %d", range);
2038 cinfo->range = GST_VIDEO_COLOR_RANGE_UNKNOWN;
2039 break;
2040 }
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]2041 GST_DEBUG("cinfo update 3 time | range:%d, matrix:%d, transfer:%d, primaries:%d", cinfo->range, cinfo->matrix, cinfo->transfer, cinfo->primaries);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]2042
2043 switch (matrix)
2044 {
2045 case V4L2_YCBCR_ENC_XV601:
2046 case V4L2_YCBCR_ENC_SYCC:
2047 GST_FIXME("XV601 and SYCC not defined, assuming 601");
2048 /* fallthrough */
2049 case V4L2_YCBCR_ENC_601:
2050 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
2051 break;
2052 case V4L2_YCBCR_ENC_XV709:
2053 GST_FIXME("XV709 not defined, assuming 709");
2054 /* fallthrough */
2055 case V4L2_YCBCR_ENC_709:
2056 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT709;
2057 break;
2058 case V4L2_YCBCR_ENC_BT2020_CONST_LUM:
2059 GST_FIXME("BT2020 with constant luma is not defined, assuming BT2020");
2060 /* fallthrough */
2061 case V4L2_YCBCR_ENC_BT2020:
2062 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT2020;
2063 break;
2064 case V4L2_YCBCR_ENC_SMPTE240M:
2065 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_SMPTE240M;
2066 break;
2067 case V4L2_YCBCR_ENC_DEFAULT:
2068 /* nothing, just use defaults for colorspace */
2069 break;
2070 default:
2071 GST_WARNING("Unknown enum v4l2_ycbcr_encoding value %d", matrix);
2072 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_UNKNOWN;
2073 break;
2074 }
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]2075 GST_DEBUG("cinfo update 4 time | range:%d, matrix:%d, transfer:%d, primaries:%d", cinfo->range, cinfo->matrix, cinfo->transfer, cinfo->primaries);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]2076
2077 /* Set identity matrix for R'G'B' formats to avoid creating
2078 * confusion. This though is cosmetic as it's now properly ignored by
2079 * the video info API and videoconvert. */
2080 if (is_rgb)
2081 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_RGB;
2082
2083 switch (transfer)
2084 {
2085 case V4L2_XFER_FUNC_709:
2086 if (colorspace == V4L2_COLORSPACE_BT2020 && fmt->fmt.pix.height >= 2160)
2087 cinfo->transfer = GST_VIDEO_TRANSFER_BT2020_12;
2088 else
2089 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
2090 break;
2091 case V4L2_XFER_FUNC_SRGB:
2092 cinfo->transfer = GST_VIDEO_TRANSFER_SRGB;
2093 break;
2094 case V4L2_XFER_FUNC_OPRGB:
2095 cinfo->transfer = GST_VIDEO_TRANSFER_ADOBERGB;
2096 break;
2097 case V4L2_XFER_FUNC_SMPTE240M:
2098 cinfo->transfer = GST_VIDEO_TRANSFER_SMPTE240M;
2099 break;
2100 case V4L2_XFER_FUNC_NONE:
2101 cinfo->transfer = GST_VIDEO_TRANSFER_GAMMA10;
2102 break;
2103 case V4L2_XFER_FUNC_DEFAULT:
2104 /* nothing, just use defaults for colorspace */
2105 break;
2106 default:
2107 GST_WARNING("Unknown enum v4l2_xfer_func value %d", transfer);
2108 cinfo->transfer = GST_VIDEO_TRANSFER_UNKNOWN;
2109 break;
2110 }
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]2111 GST_DEBUG("cinfo update 5 time | range:%d, matrix:%d, transfer:%d, primaries:%d", cinfo->range, cinfo->matrix, cinfo->transfer, cinfo->primaries);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]2112
2113done:
2114 return ret;
2115}
2116
2117static int
2118gst_aml_v4l2_object_try_fmt(GstAmlV4l2Object *v4l2object,
2119 struct v4l2_format *try_fmt)
2120{
2121 int fd = v4l2object->video_fd;
2122 struct v4l2_format fmt;
2123 int r;
2124
2125 memcpy(&fmt, try_fmt, sizeof(fmt));
2126 r = v4l2object->ioctl(fd, VIDIOC_TRY_FMT, &fmt);
2127
2128 if (r < 0 && errno == ENOTTY)
2129 {
2130 /* The driver might not implement TRY_FMT, in which case we will try
2131 S_FMT to probe */
2132 if (GST_AML_V4L2_IS_ACTIVE(v4l2object))
2133 goto error;
2134
2135 memcpy(&fmt, try_fmt, sizeof(fmt));
2136 r = v4l2object->ioctl(fd, VIDIOC_S_FMT, &fmt);
2137 }
2138 memcpy(try_fmt, &fmt, sizeof(fmt));
2139
2140 return r;
2141
2142error:
2143 memcpy(try_fmt, &fmt, sizeof(fmt));
2144 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2145 "Unable to try format: %s", g_strerror(errno));
2146 return r;
2147}
2148
2149static void
2150gst_aml_v4l2_object_add_interlace_mode(GstAmlV4l2Object *v4l2object,
2151 GstStructure *s, guint32 width, guint32 height, guint32 pixelformat)
2152{
2153 struct v4l2_format fmt;
2154 GValue interlace_formats = {
2155 0,
2156 };
2157 enum v4l2_field formats[] = {V4L2_FIELD_NONE, V4L2_FIELD_INTERLACED};
2158 gsize i;
2159 GstVideoInterlaceMode interlace_mode, prev = -1;
2160
2161 if (!g_str_equal(gst_structure_get_name(s), "video/x-raw"))
2162 return;
2163
2164 if (v4l2object->never_interlaced)
2165 {
2166 gst_structure_set(s, "interlace-mode", G_TYPE_STRING, "progressive", NULL);
2167 return;
2168 }
2169
2170 g_value_init(&interlace_formats, GST_TYPE_LIST);
2171
2172 /* Try twice - once for NONE, once for INTERLACED. */
2173 for (i = 0; i < G_N_ELEMENTS(formats); i++)
2174 {
2175 memset(&fmt, 0, sizeof(fmt));
2176 fmt.type = v4l2object->type;
2177 fmt.fmt.pix.width = width;
2178 fmt.fmt.pix.height = height;
2179 fmt.fmt.pix.pixelformat = pixelformat;
2180 fmt.fmt.pix.field = formats[i];
2181
2182 if (gst_aml_v4l2_object_try_fmt(v4l2object, &fmt) == 0 &&
2183 gst_aml_v4l2_object_get_interlace_mode(fmt.fmt.pix.field, &interlace_mode) && prev != interlace_mode)
2184 {
2185 GValue interlace_enum = {
2186 0,
2187 };
2188 const gchar *mode_string;
2189 g_value_init(&interlace_enum, G_TYPE_STRING);
2190 mode_string = gst_video_interlace_mode_to_string(interlace_mode);
2191 g_value_set_string(&interlace_enum, mode_string);
2192 gst_value_list_append_and_take_value(&interlace_formats,
2193 &interlace_enum);
2194 prev = interlace_mode;
2195 }
2196 }
2197
2198 if (gst_aml_v4l2src_value_simplify(&interlace_formats) || gst_value_list_get_size(&interlace_formats) > 0)
2199 gst_structure_take_value(s, "interlace-mode", &interlace_formats);
2200 else
2201 GST_WARNING_OBJECT(v4l2object, "Failed to determine interlace mode");
2202
2203 return;
2204}
2205
2206static void
2207gst_aml_v4l2_object_fill_colorimetry_list(GValue *list,
2208 GstVideoColorimetry *cinfo)
2209{
2210 GValue colorimetry = G_VALUE_INIT;
2211 guint size;
2212 guint i;
2213 gboolean found = FALSE;
2214
2215 g_value_init(&colorimetry, G_TYPE_STRING);
2216 g_value_take_string(&colorimetry, gst_video_colorimetry_to_string(cinfo));
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]2217 GST_DEBUG("fill colorimetry:%s into list", gst_video_colorimetry_to_string(cinfo));
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]2218
2219 /* only insert if no duplicate */
2220 size = gst_value_list_get_size(list);
2221 for (i = 0; i < size; i++)
2222 {
2223 const GValue *tmp;
2224
2225 tmp = gst_value_list_get_value(list, i);
2226 if (gst_value_compare(&colorimetry, tmp) == GST_VALUE_EQUAL)
2227 {
2228 found = TRUE;
2229 break;
2230 }
2231 }
2232
2233 if (!found)
2234 gst_value_list_append_and_take_value(list, &colorimetry);
2235 else
2236 g_value_unset(&colorimetry);
2237}
2238
2239static void
2240gst_aml_v4l2_object_add_colorspace(GstAmlV4l2Object *v4l2object, GstStructure *s,
2241 guint32 width, guint32 height, guint32 pixelformat)
2242{
2243 struct v4l2_format fmt;
2244 GValue list = G_VALUE_INIT;
2245 GstVideoColorimetry cinfo;
2246 enum v4l2_colorspace req_cspace;
2247
2248 memset(&fmt, 0, sizeof(fmt));
2249 fmt.type = v4l2object->type;
2250 fmt.fmt.pix.width = width;
2251 fmt.fmt.pix.height = height;
2252 fmt.fmt.pix.pixelformat = pixelformat;
2253
2254 g_value_init(&list, GST_TYPE_LIST);
2255
2256 /* step 1: get device default colorspace and insert it first as
2257 * it should be the preferred one */
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]2258 GST_DEBUG("try for pixl format");
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]2259 if (gst_aml_v4l2_object_try_fmt(v4l2object, &fmt) == 0)
2260 {
2261 if (gst_aml_v4l2_object_get_colorspace(&fmt, &cinfo))
2262 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2263 }
2264
2265 /* step 2: probe all colorspace other than default
2266 * We don't probe all colorspace, range, matrix and transfer combination to
2267 * avoid ioctl flooding which could greatly increase initialization time
2268 * with low-speed devices (UVC...) */
2269 for (req_cspace = V4L2_COLORSPACE_SMPTE170M;
2270 req_cspace <= V4L2_COLORSPACE_RAW; req_cspace++)
2271 {
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]2272 GST_DEBUG("try for pixl format in while loop :%d", req_cspace);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]2273 /* V4L2_COLORSPACE_BT878 is deprecated and shall not be used, so skip */
2274 if (req_cspace == V4L2_COLORSPACE_BT878)
2275 continue;
2276
2277 if (V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type))
2278 fmt.fmt.pix_mp.colorspace = req_cspace;
2279 else
2280 fmt.fmt.pix.colorspace = req_cspace;
2281
2282 if (gst_aml_v4l2_object_try_fmt(v4l2object, &fmt) == 0)
2283 {
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]2284 GST_DEBUG("try for pixl format in while loop :%d tried ok", req_cspace);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]2285 enum v4l2_colorspace colorspace;
2286
2287 if (V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type))
2288 colorspace = fmt.fmt.pix_mp.colorspace;
2289 else
2290 colorspace = fmt.fmt.pix.colorspace;
2291
2292 if (colorspace == req_cspace)
2293 {
2294 if (gst_aml_v4l2_object_get_colorspace(&fmt, &cinfo))
2295 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2296 }
2297 }
2298 }
2299
xuesong.jiang7b0882c2022-06-22 14:10:30 +0800[diff] [blame]2300 GST_DEBUG("deal: caps with colorimetry 2,3,14,7");
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]2301 cinfo.range = 2;
2302 cinfo.matrix = 3;
2303 cinfo.transfer = 14;
2304 cinfo.primaries = 7;
2305 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2306
xuesong.jiang7b0882c2022-06-22 14:10:30 +0800[diff] [blame]2307 GST_DEBUG("deal: caps with colorimetry 2,6,13,7");
2308 cinfo.range = 2;
2309 cinfo.matrix = 6;
2310 cinfo.transfer = 13;
2311 cinfo.primaries = 7;
2312 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2313
xuesong.jiang5c9aca72022-07-12 16:29:24 +0800[diff] [blame^]2314 GST_DEBUG("deal: caps with colorimetry 2,6,14,7");
2315 cinfo.range = 2;
2316 cinfo.matrix = 6;
2317 cinfo.transfer = 14;
2318 cinfo.primaries = 7;
2319 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2320
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]2321 if (gst_value_list_get_size(&list) > 0)
2322 gst_structure_take_value(s, "colorimetry", &list);
2323 else
2324 g_value_unset(&list);
2325
2326 return;
2327}
2328
2329/* The frame interval enumeration code first appeared in Linux 2.6.19. */
2330static GstStructure *
2331gst_aml_v4l2_object_probe_caps_for_format_and_size(GstAmlV4l2Object *v4l2object,
2332 guint32 pixelformat,
2333 guint32 width, guint32 height, const GstStructure *template)
2334{
2335 gint fd = v4l2object->video_fd;
2336 struct v4l2_frmivalenum ival;
2337 guint32 num, denom;
2338 GstStructure *s;
2339 GValue rates = {
2340 0,
2341 };
2342
2343 memset(&ival, 0, sizeof(struct v4l2_frmivalenum));
2344 ival.index = 0;
2345 ival.pixel_format = pixelformat;
2346 ival.width = width;
2347 ival.height = height;
2348
2349 GST_LOG_OBJECT(v4l2object->dbg_obj,
2350 "get frame interval for %ux%u, %" GST_FOURCC_FORMAT, width, height,
2351 GST_FOURCC_ARGS(pixelformat));
2352
2353 /* keep in mind that v4l2 gives us frame intervals (durations); we invert the
2354 * fraction to get framerate */
2355 if (v4l2object->ioctl(fd, VIDIOC_ENUM_FRAMEINTERVALS, &ival) < 0)
2356 goto enum_frameintervals_failed;
2357
2358 if (ival.type == V4L2_FRMIVAL_TYPE_DISCRETE)
2359 {
2360 GValue rate = {
2361 0,
2362 };
2363
2364 g_value_init(&rates, GST_TYPE_LIST);
2365 g_value_init(&rate, GST_TYPE_FRACTION);
2366
2367 do
2368 {
2369 num = ival.discrete.numerator;
2370 denom = ival.discrete.denominator;
2371
2372 if (num > G_MAXINT || denom > G_MAXINT)
2373 {
2374 /* let us hope we don't get here... */
2375 num >>= 1;
2376 denom >>= 1;
2377 }
2378
2379 GST_LOG_OBJECT(v4l2object->dbg_obj, "adding discrete framerate: %d/%d",
2380 denom, num);
2381
2382 /* swap to get the framerate */
2383 gst_value_set_fraction(&rate, denom, num);
2384 gst_value_list_append_value(&rates, &rate);
2385
2386 ival.index++;
2387 } while (v4l2object->ioctl(fd, VIDIOC_ENUM_FRAMEINTERVALS, &ival) >= 0);
2388 }
2389 else if (ival.type == V4L2_FRMIVAL_TYPE_STEPWISE)
2390 {
2391 GValue min = {
2392 0,
2393 };
2394 GValue step = {
2395 0,
2396 };
2397 GValue max = {
2398 0,
2399 };
2400 gboolean added = FALSE;
2401 guint32 minnum, mindenom;
2402 guint32 maxnum, maxdenom;
2403
2404 g_value_init(&rates, GST_TYPE_LIST);
2405
2406 g_value_init(&min, GST_TYPE_FRACTION);
2407 g_value_init(&step, GST_TYPE_FRACTION);
2408 g_value_init(&max, GST_TYPE_FRACTION);
2409
2410 /* get the min */
2411 minnum = ival.stepwise.min.numerator;
2412 mindenom = ival.stepwise.min.denominator;
2413 if (minnum > G_MAXINT || mindenom > G_MAXINT)
2414 {
2415 minnum >>= 1;
2416 mindenom >>= 1;
2417 }
2418 GST_LOG_OBJECT(v4l2object->dbg_obj, "stepwise min frame interval: %d/%d",
2419 minnum, mindenom);
2420 gst_value_set_fraction(&min, minnum, mindenom);
2421
2422 /* get the max */
2423 maxnum = ival.stepwise.max.numerator;
2424 maxdenom = ival.stepwise.max.denominator;
2425 if (maxnum > G_MAXINT || maxdenom > G_MAXINT)
2426 {
2427 maxnum >>= 1;
2428 maxdenom >>= 1;
2429 }
2430
2431 GST_LOG_OBJECT(v4l2object->dbg_obj, "stepwise max frame interval: %d/%d",
2432 maxnum, maxdenom);
2433 gst_value_set_fraction(&max, maxnum, maxdenom);
2434
2435 /* get the step */
2436 num = ival.stepwise.step.numerator;
2437 denom = ival.stepwise.step.denominator;
2438 if (num > G_MAXINT || denom > G_MAXINT)
2439 {
2440 num >>= 1;
2441 denom >>= 1;
2442 }
2443
2444 if (num == 0 || denom == 0)
2445 {
2446 /* in this case we have a wrong fraction or no step, set the step to max
2447 * so that we only add the min value in the loop below */
2448 num = maxnum;
2449 denom = maxdenom;
2450 }
2451
2452 /* since we only have gst_value_fraction_subtract and not add, negate the
2453 * numerator */
2454 GST_LOG_OBJECT(v4l2object->dbg_obj, "stepwise step frame interval: %d/%d",
2455 num, denom);
2456 gst_value_set_fraction(&step, -num, denom);
2457
2458 while (gst_value_compare(&min, &max) != GST_VALUE_GREATER_THAN)
2459 {
2460 GValue rate = {
2461 0,
2462 };
2463
2464 num = gst_value_get_fraction_numerator(&min);
2465 denom = gst_value_get_fraction_denominator(&min);
2466 GST_LOG_OBJECT(v4l2object->dbg_obj, "adding stepwise framerate: %d/%d",
2467 denom, num);
2468
2469 /* invert to get the framerate */
2470 g_value_init(&rate, GST_TYPE_FRACTION);
2471 gst_value_set_fraction(&rate, denom, num);
2472 gst_value_list_append_value(&rates, &rate);
2473 added = TRUE;
2474
2475 /* we're actually adding because step was negated above. This is because
2476 * there is no _add function... */
2477 if (!gst_value_fraction_subtract(&min, &min, &step))
2478 {
2479 GST_WARNING_OBJECT(v4l2object->dbg_obj, "could not step fraction!");
2480 break;
2481 }
2482 }
2483 if (!added)
2484 {
2485 /* no range was added, leave the default range from the template */
2486 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2487 "no range added, leaving default");
2488 g_value_unset(&rates);
2489 }
2490 }
2491 else if (ival.type == V4L2_FRMIVAL_TYPE_CONTINUOUS)
2492 {
2493 guint32 maxnum, maxdenom;
2494
2495 g_value_init(&rates, GST_TYPE_FRACTION_RANGE);
2496
2497 num = ival.stepwise.min.numerator;
2498 denom = ival.stepwise.min.denominator;
2499 if (num > G_MAXINT || denom > G_MAXINT)
2500 {
2501 num >>= 1;
2502 denom >>= 1;
2503 }
2504
2505 maxnum = ival.stepwise.max.numerator;
2506 maxdenom = ival.stepwise.max.denominator;
2507 if (maxnum > G_MAXINT || maxdenom > G_MAXINT)
2508 {
2509 maxnum >>= 1;
2510 maxdenom >>= 1;
2511 }
2512
2513 GST_LOG_OBJECT(v4l2object->dbg_obj,
2514 "continuous frame interval %d/%d to %d/%d", maxdenom, maxnum, denom,
2515 num);
2516
2517 gst_value_set_fraction_range_full(&rates, maxdenom, maxnum, denom, num);
2518 }
2519 else
2520 {
2521 goto unknown_type;
2522 }
2523
2524return_data:
2525 s = gst_structure_copy(template);
2526 gst_structure_set(s, "width", G_TYPE_INT, (gint)width,
2527 "height", G_TYPE_INT, (gint)height, NULL);
2528
2529 gst_aml_v4l2_object_add_aspect_ratio(v4l2object, s);
2530
2531 if (!v4l2object->skip_try_fmt_probes)
2532 {
2533 gst_aml_v4l2_object_add_interlace_mode(v4l2object, s, width, height,
2534 pixelformat);
2535 gst_aml_v4l2_object_add_colorspace(v4l2object, s, width, height, pixelformat);
2536 }
2537
2538 if (G_IS_VALUE(&rates))
2539 {
2540 gst_aml_v4l2src_value_simplify(&rates);
2541 /* only change the framerate on the template when we have a valid probed new
2542 * value */
2543 gst_structure_take_value(s, "framerate", &rates);
2544 }
2545 else if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE ||
2546 v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
2547 {
2548 gst_structure_set(s, "framerate", GST_TYPE_FRACTION_RANGE, 0, 1, G_MAXINT,
2549 1, NULL);
2550 }
2551 return s;
2552
2553 /* ERRORS */
2554enum_frameintervals_failed:
2555{
2556 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
2557 "Unable to enumerate intervals for %" GST_FOURCC_FORMAT "@%ux%u",
2558 GST_FOURCC_ARGS(pixelformat), width, height);
2559 goto return_data;
2560}
2561unknown_type:
2562{
2563 /* I don't see how this is actually an error, we ignore the format then */
2564 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2565 "Unknown frame interval type at %" GST_FOURCC_FORMAT "@%ux%u: %u",
2566 GST_FOURCC_ARGS(pixelformat), width, height, ival.type);
2567 return NULL;
2568}
2569}
2570
2571static gint
2572sort_by_frame_size(GstStructure *s1, GstStructure *s2)
2573{
2574 int w1, h1, w2, h2;
2575
2576 gst_structure_get_int(s1, "width", &w1);
2577 gst_structure_get_int(s1, "height", &h1);
2578 gst_structure_get_int(s2, "width", &w2);
2579 gst_structure_get_int(s2, "height", &h2);
2580
2581 /* I think it's safe to assume that this won't overflow for a while */
2582 return ((w2 * h2) - (w1 * h1));
2583}
2584
2585static void
2586gst_aml_v4l2_object_update_and_append(GstAmlV4l2Object *v4l2object,
2587 guint32 format, GstCaps *caps, GstStructure *s)
2588{
2589 GstStructure *alt_s = NULL;
2590
2591 /* Encoded stream on output buffer need to be parsed */
2592 if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT ||
2593 v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
2594 {
2595 gint i = 0;
2596
2597 for (; i < GST_AML_V4L2_FORMAT_COUNT; i++)
2598 {
2599 if (format == gst_aml_v4l2_formats[i].format &&
2600 gst_aml_v4l2_formats[i].flags & GST_V4L2_CODEC &&
2601 !(gst_aml_v4l2_formats[i].flags & GST_V4L2_NO_PARSE))
2602 {
2603 gst_structure_set(s, "parsed", G_TYPE_BOOLEAN, TRUE, NULL);
2604 break;
2605 }
2606 }
2607 }
2608
2609 if (v4l2object->has_alpha_component &&
2610 (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE ||
2611 v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE))
2612 {
2613 switch (format)
2614 {
2615 case V4L2_PIX_FMT_RGB32:
2616 alt_s = gst_structure_copy(s);
2617 gst_structure_set(alt_s, "format", G_TYPE_STRING, "ARGB", NULL);
2618 break;
2619 case V4L2_PIX_FMT_BGR32:
2620 alt_s = gst_structure_copy(s);
2621 gst_structure_set(alt_s, "format", G_TYPE_STRING, "BGRA", NULL);
2622 break;
2623 default:
2624 break;
2625 }
2626 }
2627
2628 gst_caps_append_structure(caps, s);
2629
2630 if (alt_s)
2631 gst_caps_append_structure(caps, alt_s);
2632}
2633
2634static GstCaps *
2635gst_aml_v4l2_object_probe_caps_for_format(GstAmlV4l2Object *v4l2object,
2636 guint32 pixelformat, const GstStructure *template)
2637{
2638 GstCaps *ret = gst_caps_new_empty();
2639 GstStructure *tmp;
2640 gint fd = v4l2object->video_fd;
2641 struct v4l2_frmsizeenum size;
2642 GList *results = NULL;
2643 guint32 w, h;
2644
2645 if (pixelformat == GST_MAKE_FOURCC('M', 'P', 'E', 'G'))
2646 {
2647 gst_caps_append_structure(ret, gst_structure_copy(template));
2648 return ret;
2649 }
2650
2651 memset(&size, 0, sizeof(struct v4l2_frmsizeenum));
2652 size.index = 0;
2653 size.pixel_format = pixelformat;
2654
2655 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
2656 "Enumerating frame sizes for %" GST_FOURCC_FORMAT,
2657 GST_FOURCC_ARGS(pixelformat));
2658
2659 if (v4l2object->ioctl(fd, VIDIOC_ENUM_FRAMESIZES, &size) < 0)
2660 goto enum_framesizes_failed;
2661
2662 if (size.type == V4L2_FRMSIZE_TYPE_DISCRETE)
2663 {
2664 do
2665 {
2666 GST_LOG_OBJECT(v4l2object->dbg_obj, "got discrete frame size %dx%d",
2667 size.discrete.width, size.discrete.height);
2668
2669 w = MIN(size.discrete.width, G_MAXINT);
2670 h = MIN(size.discrete.height, G_MAXINT);
2671
2672 if (w && h)
2673 {
2674 tmp =
2675 gst_aml_v4l2_object_probe_caps_for_format_and_size(v4l2object,
2676 pixelformat, w, h, template);
2677
2678 if (tmp)
2679 results = g_list_prepend(results, tmp);
2680 }
2681
2682 size.index++;
2683 } while (v4l2object->ioctl(fd, VIDIOC_ENUM_FRAMESIZES, &size) >= 0);
2684 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
2685 "done iterating discrete frame sizes");
2686 }
2687 else if (size.type == V4L2_FRMSIZE_TYPE_STEPWISE)
2688 {
2689 guint32 maxw, maxh, step_w, step_h;
2690
2691 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "we have stepwise frame sizes:");
2692 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min width: %d",
2693 size.stepwise.min_width);
2694 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min height: %d",
2695 size.stepwise.min_height);
2696 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "max width: %d",
2697 size.stepwise.max_width);
2698 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min height: %d",
2699 size.stepwise.max_height);
2700 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "step width: %d",
2701 size.stepwise.step_width);
2702 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "step height: %d",
2703 size.stepwise.step_height);
2704
2705 w = MAX(size.stepwise.min_width, 1);
2706 h = MAX(size.stepwise.min_height, 1);
2707 maxw = MIN(size.stepwise.max_width, G_MAXINT);
2708 maxh = MIN(size.stepwise.max_height, G_MAXINT);
2709
2710 step_w = MAX(size.stepwise.step_width, 1);
2711 step_h = MAX(size.stepwise.step_height, 1);
2712
2713 /* FIXME: check for sanity and that min/max are multiples of the steps */
2714
2715 /* we only query details for the max width/height since it's likely the
2716 * most restricted if there are any resolution-dependent restrictions */
2717 tmp = gst_aml_v4l2_object_probe_caps_for_format_and_size(v4l2object,
2718 pixelformat, maxw, maxh, template);
2719
2720 if (tmp)
2721 {
2722 GValue step_range = G_VALUE_INIT;
2723
2724 g_value_init(&step_range, GST_TYPE_INT_RANGE);
2725 gst_value_set_int_range_step(&step_range, w, maxw, step_w);
2726 gst_structure_set_value(tmp, "width", &step_range);
2727
2728 gst_value_set_int_range_step(&step_range, h, maxh, step_h);
2729 gst_structure_take_value(tmp, "height", &step_range);
2730
2731 /* no point using the results list here, since there's only one struct */
2732 gst_aml_v4l2_object_update_and_append(v4l2object, pixelformat, ret, tmp);
2733 }
2734 }
2735 else if (size.type == V4L2_FRMSIZE_TYPE_CONTINUOUS)
2736 {
2737 guint32 maxw, maxh;
2738
2739 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "we have continuous frame sizes:");
2740 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min width: %d",
2741 size.stepwise.min_width);
2742 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min height: %d",
2743 size.stepwise.min_height);
2744 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "max width: %d",
2745 size.stepwise.max_width);
2746 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min height: %d",
2747 size.stepwise.max_height);
2748
2749 w = MAX(size.stepwise.min_width, 1);
2750 h = MAX(size.stepwise.min_height, 1);
2751 maxw = MIN(size.stepwise.max_width, G_MAXINT);
2752 maxh = MIN(size.stepwise.max_height, G_MAXINT);
2753
2754 tmp =
2755 gst_aml_v4l2_object_probe_caps_for_format_and_size(v4l2object, pixelformat,
2756 w, h, template);
2757 if (tmp)
2758 {
2759 gst_structure_set(tmp, "width", GST_TYPE_INT_RANGE, (gint)w,
2760 (gint)maxw, "height", GST_TYPE_INT_RANGE, (gint)h, (gint)maxh,
2761 NULL);
2762
2763 /* no point using the results list here, since there's only one struct */
2764 gst_aml_v4l2_object_update_and_append(v4l2object, pixelformat, ret, tmp);
2765 }
2766 }
2767 else
2768 {
2769 goto unknown_type;
2770 }
2771
2772 /* we use an intermediary list to store and then sort the results of the
2773 * probing because we can't make any assumptions about the order in which
2774 * the driver will give us the sizes, but we want the final caps to contain
2775 * the results starting with the highest resolution and having the lowest
2776 * resolution last, since order in caps matters for things like fixation. */
2777 results = g_list_sort(results, (GCompareFunc)sort_by_frame_size);
2778 while (results != NULL)
2779 {
2780 gst_aml_v4l2_object_update_and_append(v4l2object, pixelformat, ret,
2781 results->data);
2782 results = g_list_delete_link(results, results);
2783 }
2784
2785 if (gst_caps_is_empty(ret))
2786 goto enum_framesizes_no_results;
2787
2788 return ret;
2789
2790 /* ERRORS */
2791enum_framesizes_failed:
2792{
2793 /* I don't see how this is actually an error */
2794 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
2795 "Failed to enumerate frame sizes for pixelformat %" GST_FOURCC_FORMAT
2796 " (%s)",
2797 GST_FOURCC_ARGS(pixelformat), g_strerror(errno));
2798 goto default_frame_sizes;
2799}
2800enum_framesizes_no_results:
2801{
2802 /* it's possible that VIDIOC_ENUM_FRAMESIZES is defined but the driver in
2803 * question doesn't actually support it yet */
2804 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
2805 "No results for pixelformat %" GST_FOURCC_FORMAT
2806 " enumerating frame sizes, trying fallback",
2807 GST_FOURCC_ARGS(pixelformat));
2808 goto default_frame_sizes;
2809}
2810unknown_type:
2811{
2812 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2813 "Unknown frame sizeenum type for pixelformat %" GST_FOURCC_FORMAT
2814 ": %u",
2815 GST_FOURCC_ARGS(pixelformat), size.type);
2816 goto default_frame_sizes;
2817}
2818
2819default_frame_sizes:
2820{
2821 gint min_w, max_w, min_h, max_h, fix_num = 0, fix_denom = 0;
2822
2823 /* This code is for Linux < 2.6.19 */
2824 min_w = min_h = 1;
2825 max_w = max_h = GST_AML_V4L2_MAX_SIZE;
2826 if (!gst_aml_v4l2_object_get_nearest_size(v4l2object, pixelformat, &min_w,
2827 &min_h))
2828 {
2829 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2830 "Could not probe minimum capture size for pixelformat %" GST_FOURCC_FORMAT, GST_FOURCC_ARGS(pixelformat));
2831 }
2832 if (!gst_aml_v4l2_object_get_nearest_size(v4l2object, pixelformat, &max_w,
2833 &max_h))
2834 {
2835 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2836 "Could not probe maximum capture size for pixelformat %" GST_FOURCC_FORMAT, GST_FOURCC_ARGS(pixelformat));
2837 }
2838
2839 tmp = gst_structure_copy(template);
2840 if (fix_num)
2841 {
2842 gst_structure_set(tmp, "framerate", GST_TYPE_FRACTION, fix_num,
2843 fix_denom, NULL);
2844 }
2845 else if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE ||
2846 v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
2847 {
2848 /* if norm can't be used, copy the template framerate */
2849 gst_structure_set(tmp, "framerate", GST_TYPE_FRACTION_RANGE, 0, 1,
2850 G_MAXINT, 1, NULL);
2851 }
2852
2853 if (min_w == max_w)
2854 gst_structure_set(tmp, "width", G_TYPE_INT, max_w, NULL);
2855 else
2856 gst_structure_set(tmp, "width", GST_TYPE_INT_RANGE, min_w, max_w, NULL);
2857
2858 if (min_h == max_h)
2859 gst_structure_set(tmp, "height", G_TYPE_INT, max_h, NULL);
2860 else
2861 gst_structure_set(tmp, "height", GST_TYPE_INT_RANGE, min_h, max_h, NULL);
2862
2863 gst_aml_v4l2_object_add_aspect_ratio(v4l2object, tmp);
2864
2865 if (!v4l2object->skip_try_fmt_probes)
2866 {
2867 /* We could consider setting interlace mode from min and max. */
2868 gst_aml_v4l2_object_add_interlace_mode(v4l2object, tmp, max_w, max_h,
2869 pixelformat);
2870 /* We could consider to check colorspace for min too, in case it depends on
2871 * the size. But in this case, min and max could not be enough */
2872 gst_aml_v4l2_object_add_colorspace(v4l2object, tmp, max_w, max_h,
2873 pixelformat);
2874 }
2875
2876 gst_aml_v4l2_object_update_and_append(v4l2object, pixelformat, ret, tmp);
2877 return ret;
2878}
2879}
2880
2881static gboolean
2882gst_aml_v4l2_object_get_nearest_size(GstAmlV4l2Object *v4l2object,
2883 guint32 pixelformat, gint *width, gint *height)
2884{
2885 struct v4l2_format fmt;
2886 gboolean ret = FALSE;
2887 GstVideoInterlaceMode interlace_mode;
2888
2889 g_return_val_if_fail(width != NULL, FALSE);
2890 g_return_val_if_fail(height != NULL, FALSE);
2891
2892 GST_LOG_OBJECT(v4l2object->dbg_obj,
2893 "getting nearest size to %dx%d with format %" GST_FOURCC_FORMAT,
2894 *width, *height, GST_FOURCC_ARGS(pixelformat));
2895
2896 memset(&fmt, 0, sizeof(struct v4l2_format));
2897
2898 /* get size delimiters */
2899 memset(&fmt, 0, sizeof(fmt));
2900 fmt.type = v4l2object->type;
2901 fmt.fmt.pix.width = *width;
2902 fmt.fmt.pix.height = *height;
2903 fmt.fmt.pix.pixelformat = pixelformat;
2904 fmt.fmt.pix.field = V4L2_FIELD_ANY;
2905
2906 if (gst_aml_v4l2_object_try_fmt(v4l2object, &fmt) < 0)
2907 goto error;
2908
2909 GST_LOG_OBJECT(v4l2object->dbg_obj,
2910 "got nearest size %dx%d", fmt.fmt.pix.width, fmt.fmt.pix.height);
2911
2912 *width = fmt.fmt.pix.width;
2913 *height = fmt.fmt.pix.height;
2914
2915 if (!gst_aml_v4l2_object_get_interlace_mode(fmt.fmt.pix.field, &interlace_mode))
2916 {
2917 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2918 "Unsupported field type for %" GST_FOURCC_FORMAT "@%ux%u: %u",
2919 GST_FOURCC_ARGS(pixelformat), *width, *height, fmt.fmt.pix.field);
2920 goto error;
2921 }
2922
2923 ret = TRUE;
2924
2925error:
2926 if (!ret)
2927 {
2928 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2929 "Unable to try format: %s", g_strerror(errno));
2930 }
2931
2932 return ret;
2933}
2934
2935static gboolean
2936gst_aml_v4l2_object_is_dmabuf_supported(GstAmlV4l2Object *v4l2object)
2937{
2938 gboolean ret = TRUE;
2939 struct v4l2_exportbuffer expbuf = {
2940 .type = v4l2object->type,
2941 .index = -1,
2942 .plane = -1,
2943 .flags = O_CLOEXEC | O_RDWR,
2944 };
2945
2946 if (v4l2object->fmtdesc->flags & V4L2_FMT_FLAG_EMULATED)
2947 {
2948 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2949 "libv4l2 converter detected, disabling DMABuf");
2950 ret = FALSE;
2951 }
2952
2953 /* Expected to fail, but ENOTTY tells us that it is not implemented. */
2954 v4l2object->ioctl(v4l2object->video_fd, VIDIOC_EXPBUF, &expbuf);
2955 if (errno == ENOTTY)
2956 ret = FALSE;
2957
2958 return ret;
2959}
2960
2961static gboolean
2962gst_aml_v4l2_object_setup_pool(GstAmlV4l2Object *v4l2object, GstCaps *caps)
2963{
2964 GstAmlV4l2IOMode mode;
2965
2966 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "initializing the %s system",
2967 V4L2_TYPE_IS_OUTPUT(v4l2object->type) ? "output" : "capture");
2968
2969 GST_AML_V4L2_CHECK_OPEN(v4l2object);
2970 GST_AML_V4L2_CHECK_NOT_ACTIVE(v4l2object);
2971
2972 /* find transport */
2973 mode = v4l2object->req_mode;
2974
2975 if (v4l2object->device_caps & V4L2_CAP_READWRITE)
2976 {
2977 if (v4l2object->req_mode == GST_V4L2_IO_AUTO)
2978 mode = GST_V4L2_IO_RW;
2979 }
2980 else if (v4l2object->req_mode == GST_V4L2_IO_RW)
2981 goto method_not_supported;
2982
2983 if (v4l2object->device_caps & V4L2_CAP_STREAMING)
2984 {
2985 if (v4l2object->req_mode == GST_V4L2_IO_AUTO)
2986 {
2987 if (!V4L2_TYPE_IS_OUTPUT(v4l2object->type) &&
2988 gst_aml_v4l2_object_is_dmabuf_supported(v4l2object))
2989 {
2990 mode = GST_V4L2_IO_DMABUF;
2991 }
2992 else
2993 {
2994 mode = GST_V4L2_IO_MMAP;
2995 }
2996 }
2997 }
2998 else if (v4l2object->req_mode == GST_V4L2_IO_MMAP ||
2999 v4l2object->req_mode == GST_V4L2_IO_DMABUF)
3000 goto method_not_supported;
3001
3002 /* if still no transport selected, error out */
3003 if (mode == GST_V4L2_IO_AUTO)
3004 goto no_supported_capture_method;
3005
3006 GST_INFO_OBJECT(v4l2object->dbg_obj, "accessing buffers via mode %d", mode);
3007 v4l2object->mode = mode;
3008
3009 /* If min_buffers is not set, the driver either does not support the control or
3010 it has not been asked yet via propose_allocation/decide_allocation. */
3011 if (!v4l2object->min_buffers)
3012 gst_aml_v4l2_get_driver_min_buffers(v4l2object);
3013
3014 /* Map the buffers */
3015 GST_LOG_OBJECT(v4l2object->dbg_obj, "initiating buffer pool");
3016
3017 if (!(v4l2object->pool = gst_aml_v4l2_buffer_pool_new(v4l2object, caps)))
3018 goto buffer_pool_new_failed;
3019
3020 GST_AML_V4L2_SET_ACTIVE(v4l2object);
3021
3022 return TRUE;
3023
3024 /* ERRORS */
3025buffer_pool_new_failed:
3026{
3027 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, READ,
3028 (_("Could not map buffers from device '%s'"),
3029 v4l2object->videodev),
3030 ("Failed to create buffer pool: %s", g_strerror(errno)));
3031 return FALSE;
3032}
3033method_not_supported:
3034{
3035 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, READ,
3036 (_("The driver of device '%s' does not support the IO method %d"),
3037 v4l2object->videodev, mode),
3038 (NULL));
3039 return FALSE;
3040}
3041no_supported_capture_method:
3042{
3043 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, READ,
3044 (_("The driver of device '%s' does not support any known IO "
3045 "method."),
3046 v4l2object->videodev),
3047 (NULL));
3048 return FALSE;
3049}
3050}
3051
3052static void
3053gst_aml_v4l2_object_set_stride(GstVideoInfo *info, GstVideoAlignment *align,
3054 gint plane, gint stride)
3055{
3056 const GstVideoFormatInfo *finfo = info->finfo;
3057
3058 if (GST_VIDEO_FORMAT_INFO_IS_TILED(finfo))
3059 {
3060 gint x_tiles, y_tiles, ws, hs, tile_height, padded_height;
3061
3062 ws = GST_VIDEO_FORMAT_INFO_TILE_WS(finfo);
3063 hs = GST_VIDEO_FORMAT_INFO_TILE_HS(finfo);
3064 tile_height = 1 << hs;
3065
3066 padded_height = GST_VIDEO_FORMAT_INFO_SCALE_HEIGHT(finfo, plane,
3067 info->height + align->padding_top + align->padding_bottom);
3068 padded_height = GST_ROUND_UP_N(padded_height, tile_height);
3069
3070 x_tiles = stride >> ws;
3071 y_tiles = padded_height >> hs;
3072 info->stride[plane] = GST_VIDEO_TILE_MAKE_STRIDE(x_tiles, y_tiles);
3073 }
3074 else
3075 {
3076 info->stride[plane] = stride;
3077 }
3078}
3079
3080static void
3081gst_aml_v4l2_object_extrapolate_info(GstAmlV4l2Object *v4l2object,
3082 GstVideoInfo *info, GstVideoAlignment *align, gint stride)
3083{
3084 const GstVideoFormatInfo *finfo = info->finfo;
3085 gint i, estride, padded_height;
3086 gsize offs = 0;
3087
3088 g_return_if_fail(v4l2object->n_v4l2_planes == 1);
3089
3090 padded_height = info->height + align->padding_top + align->padding_bottom;
3091
3092 for (i = 0; i < finfo->n_planes; i++)
3093 {
3094 estride = gst_aml_v4l2_object_extrapolate_stride(finfo, i, stride);
3095
3096 gst_aml_v4l2_object_set_stride(info, align, i, estride);
3097
3098 info->offset[i] = offs;
3099 offs += estride *
3100 GST_VIDEO_FORMAT_INFO_SCALE_HEIGHT(finfo, i, padded_height);
3101
3102 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
3103 "Extrapolated for plane %d with base stride %d: "
3104 "stride %d, offset %" G_GSIZE_FORMAT,
3105 i, stride, info->stride[i],
3106 info->offset[i]);
3107 }
3108
3109 /* Update the image size according the amount of data we are going to
3110 * read/write. This workaround bugs in driver where the sizeimage provided
3111 * by TRY/S_FMT represent the buffer length (maximum size) rather then the expected
3112 * bytesused (buffer size). */
3113 if (offs < info->size)
3114 info->size = offs;
3115}
3116
3117static void
3118gst_aml_v4l2_object_save_format(GstAmlV4l2Object *v4l2object,
3119 struct v4l2_fmtdesc *fmtdesc, struct v4l2_format *format,
3120 GstVideoInfo *info, GstVideoAlignment *align)
3121{
3122 const GstVideoFormatInfo *finfo = info->finfo;
3123 gboolean standard_stride = TRUE;
3124 gint stride, pstride, padded_width, padded_height, i;
3125
3126 if (GST_VIDEO_INFO_FORMAT(info) == GST_VIDEO_FORMAT_ENCODED)
3127 {
3128 v4l2object->n_v4l2_planes = 1;
3129 info->size = format->fmt.pix.sizeimage;
3130 goto store_info;
3131 }
3132
3133 /* adjust right padding */
3134 if (V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type))
3135 stride = format->fmt.pix_mp.plane_fmt[0].bytesperline;
3136 else
3137 stride = format->fmt.pix.bytesperline;
3138
3139 pstride = GST_VIDEO_FORMAT_INFO_PSTRIDE(finfo, 0);
3140 if (pstride)
3141 {
3142 padded_width = stride / pstride;
3143 }
3144 else
3145 {
3146 /* pstride can be 0 for complex formats */
3147 GST_WARNING_OBJECT(v4l2object->element,
3148 "format %s has a pstride of 0, cannot compute padded with",
3149 gst_video_format_to_string(GST_VIDEO_INFO_FORMAT(info)));
3150 padded_width = stride;
3151 }
3152
3153 if (padded_width < format->fmt.pix.width)
3154 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3155 "Driver bug detected, stride (%d) is too small for the width (%d)",
3156 padded_width, format->fmt.pix.width);
3157
3158 align->padding_right = padded_width - info->width - align->padding_left;
3159
3160 /* adjust bottom padding */
3161 padded_height = format->fmt.pix.height;
3162
3163 if (GST_VIDEO_FORMAT_INFO_IS_TILED(finfo))
3164 {
3165 guint hs, tile_height;
3166
3167 hs = GST_VIDEO_FORMAT_INFO_TILE_HS(finfo);
3168 tile_height = 1 << hs;
3169
3170 padded_height = GST_ROUND_UP_N(padded_height, tile_height);
3171 }
3172
3173 align->padding_bottom = padded_height - info->height - align->padding_top;
3174
3175 /* setup the strides and offset */
3176 if (V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type))
3177 {
3178 struct v4l2_pix_format_mplane *pix_mp = &format->fmt.pix_mp;
3179
3180 /* figure out the frame layout */
3181 v4l2object->n_v4l2_planes = MAX(1, pix_mp->num_planes);
3182 info->size = 0;
3183 for (i = 0; i < v4l2object->n_v4l2_planes; i++)
3184 {
3185 stride = pix_mp->plane_fmt[i].bytesperline;
3186
3187 if (info->stride[i] != stride)
3188 standard_stride = FALSE;
3189
3190 gst_aml_v4l2_object_set_stride(info, align, i, stride);
3191 info->offset[i] = info->size;
3192 info->size += pix_mp->plane_fmt[i].sizeimage;
3193 }
3194
3195 /* Extrapolate stride if planar format are being set in 1 v4l2 plane */
3196 if (v4l2object->n_v4l2_planes < finfo->n_planes)
3197 {
3198 stride = format->fmt.pix_mp.plane_fmt[0].bytesperline;
3199 gst_aml_v4l2_object_extrapolate_info(v4l2object, info, align, stride);
3200 }
3201 }
3202 else
3203 {
3204 /* only one plane in non-MPLANE mode */
3205 v4l2object->n_v4l2_planes = 1;
3206 info->size = format->fmt.pix.sizeimage;
3207 stride = format->fmt.pix.bytesperline;
3208
3209 if (info->stride[0] != stride)
3210 standard_stride = FALSE;
3211
3212 gst_aml_v4l2_object_extrapolate_info(v4l2object, info, align, stride);
3213 }
3214
3215 /* adjust the offset to take into account left and top */
3216 if (GST_VIDEO_FORMAT_INFO_IS_TILED(finfo))
3217 {
3218 if ((align->padding_left + align->padding_top) > 0)
3219 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3220 "Left and top padding is not permitted for tiled formats");
3221 }
3222 else
3223 {
3224 for (i = 0; i < finfo->n_planes; i++)
3225 {
3226 gint vedge, hedge;
3227
3228 /* FIXME we assume plane as component as this is true for all supported
3229 * format we support. */
3230
3231 hedge = GST_VIDEO_FORMAT_INFO_SCALE_WIDTH(finfo, i, align->padding_left);
3232 vedge = GST_VIDEO_FORMAT_INFO_SCALE_HEIGHT(finfo, i, align->padding_top);
3233
3234 info->offset[i] += (vedge * info->stride[i]) +
3235 (hedge * GST_VIDEO_INFO_COMP_PSTRIDE(info, i));
3236 }
3237 }
3238
3239store_info:
3240 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Got sizeimage %" G_GSIZE_FORMAT,
3241 info->size);
3242
3243 /* to avoid copies we need video meta if there is padding */
3244 v4l2object->need_video_meta =
3245 ((align->padding_top + align->padding_left + align->padding_right +
3246 align->padding_bottom) != 0);
3247
3248 /* ... or if stride is non "standard" */
3249 if (!standard_stride)
3250 v4l2object->need_video_meta = TRUE;
3251
3252 /* ... or also video meta if we use multiple, non-contiguous, planes */
3253 if (v4l2object->n_v4l2_planes > 1)
3254 v4l2object->need_video_meta = TRUE;
3255
3256 v4l2object->info = *info;
3257 v4l2object->align = *align;
3258 v4l2object->format = *format;
3259 v4l2object->fmtdesc = fmtdesc;
3260
3261 /* if we have a framerate pre-calculate duration */
3262 if (info->fps_n > 0 && info->fps_d > 0)
3263 {
3264 v4l2object->duration = gst_util_uint64_scale_int(GST_SECOND, info->fps_d,
3265 info->fps_n);
3266 }
3267 else
3268 {
3269 v4l2object->duration = GST_CLOCK_TIME_NONE;
3270 }
3271}
3272
3273gint gst_aml_v4l2_object_extrapolate_stride(const GstVideoFormatInfo *finfo,
3274 gint plane, gint stride)
3275{
3276 gint estride;
3277
3278 switch (finfo->format)
3279 {
3280 case GST_VIDEO_FORMAT_NV12:
3281 case GST_VIDEO_FORMAT_NV12_64Z32:
3282 case GST_VIDEO_FORMAT_NV21:
3283 case GST_VIDEO_FORMAT_NV16:
3284 case GST_VIDEO_FORMAT_NV61:
3285 case GST_VIDEO_FORMAT_NV24:
3286 estride = (plane == 0 ? 1 : 2) *
3287 GST_VIDEO_FORMAT_INFO_SCALE_WIDTH(finfo, plane, stride);
3288 break;
3289 default:
3290 estride = GST_VIDEO_FORMAT_INFO_SCALE_WIDTH(finfo, plane, stride);
3291 break;
3292 }
3293
3294 return estride;
3295}
3296
3297static gboolean
3298gst_aml_v4l2_video_colorimetry_matches(const GstVideoColorimetry *cinfo,
3299 const gchar *color)
3300{
3301 GstVideoColorimetry ci;
3302 static const GstVideoColorimetry ci_likely_jpeg = {
3303 GST_VIDEO_COLOR_RANGE_0_255, GST_VIDEO_COLOR_MATRIX_BT601,
3304 GST_VIDEO_TRANSFER_UNKNOWN, GST_VIDEO_COLOR_PRIMARIES_UNKNOWN};
3305 static const GstVideoColorimetry ci_jpeg = {
3306 GST_VIDEO_COLOR_RANGE_0_255, GST_VIDEO_COLOR_MATRIX_BT601,
3307 GST_VIDEO_TRANSFER_SRGB, GST_VIDEO_COLOR_PRIMARIES_BT709};
3308
3309 if (!gst_video_colorimetry_from_string(&ci, color))
3310 return FALSE;
3311
3312 if (gst_video_colorimetry_is_equal(&ci, cinfo))
3313 return TRUE;
3314
3315 /* Allow 1:4:0:0 (produced by jpegdec) if the device expects 1:4:7:1 */
3316 if (gst_video_colorimetry_is_equal(&ci, &ci_likely_jpeg) && gst_video_colorimetry_is_equal(cinfo, &ci_jpeg))
3317 return TRUE;
3318
3319 return FALSE;
3320}
3321
3322static void
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]3323set_amlogic_vdec_parm(GstAmlV4l2Object *v4l2object, struct v4l2_streamparm *streamparm, GstCaps *caps)
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]3324{
3325 struct aml_dec_params *decParm = (struct aml_dec_params *)streamparm->parm.raw_data;
3326 const char *env;
3327
3328 decParm->cfg.metadata_config_flag = 1 << 13;
3329
3330 if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT || v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
3331 {
3332 env = getenv("V4L2_SET_AMLOGIC_DW_MODE");
3333 if (env)
3334 {
3335 int dwMode = atoi(env);
3336 switch (dwMode)
3337 {
3338 case 0:
3339 case 1:
3340 case 2:
3341 case 3:
3342 case 4:
3343 case 16:
3344 decParm->cfg.double_write_mode = dwMode;
3345 decParm->parms_status |= V4L2_CONFIG_PARM_DECODE_CFGINFO;
3346 break;
3347 }
3348 }
3349
3350 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_S_PARM, streamparm) < 0)
3351 {
3352 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "set vdec parm fail");
3353 }
3354 else
3355 {
3356 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Set dwMode to %d", decParm->cfg.double_write_mode);
3357 }
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]3358
3359 GstStructure *structure= gst_caps_get_structure(caps, 0);
3360 if (structure == NULL)
3361 {
3362 return;
3363 }
3364 if ( gst_structure_has_field(structure, "colorimetry") )
3365 {
3366 const char *colorimetry= gst_structure_get_string(structure,"colorimetry");
3367 GstVideoColorimetry vci = {0};
3368 if ( colorimetry && gst_video_colorimetry_from_string( &vci, colorimetry ))
3369 {
3370 decParm->parms_status |= V4L2_CONFIG_PARM_DECODE_HDRINFO;
3371 decParm->hdr.signal_type= (1<<29); /* present flag */
3372 /*set default value, this is to keep up with driver hdr info synchronization*/
3373 decParm->hdr.signal_type |= (5<<26) | (1<<24);
3374
3375 gint hdrColorimetry[4] = {0};
3376 hdrColorimetry[0]= (int)vci.range;
3377 hdrColorimetry[1]= (int)vci.matrix;
3378 hdrColorimetry[2]= (int)vci.transfer;
3379 hdrColorimetry[3]= (int)vci.primaries;
3380 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "colorimetry: [%d,%d,%d,%d]",
3381 hdrColorimetry[0],
3382 hdrColorimetry[1],
3383 hdrColorimetry[2],
3384 hdrColorimetry[3] );
3385 /* range */
3386 switch ( hdrColorimetry[0] )
3387 {
3388 case 1:
3389 case 2:
3390 decParm->hdr.signal_type |= ((hdrColorimetry[0] % 2)<<25);
3391 break;
3392 default:
3393 break;
3394 }
3395 /* matrix coefficient */
3396 switch ( hdrColorimetry[1] )
3397 {
3398 case 1: /* RGB */
3399 decParm->hdr.signal_type |= 0;
3400 break;
3401 case 2: /* FCC */
3402 decParm->hdr.signal_type |= 4;
3403 break;
3404 case 3: /* BT709 */
3405 decParm->hdr.signal_type |= 1;
3406 break;
3407 case 4: /* BT601 */
3408 decParm->hdr.signal_type |= 3;
3409 break;
3410 case 5: /* SMPTE240M */
3411 decParm->hdr.signal_type |= 7;
3412 break;
3413 case 6: /* BT2020 */
3414 decParm->hdr.signal_type |= 9;
3415 break;
3416 default: /* unknown */
3417 decParm->hdr.signal_type |= 2;
3418 break;
3419 }
3420 /* transfer function */
3421 switch ( hdrColorimetry[2] )
3422 {
3423 case 5: /* BT709 */
3424 decParm->hdr.signal_type |= (1<<8);
3425 break;
3426 case 6: /* SMPTE240M */
3427 decParm->hdr.signal_type |= (7<<8);
3428 break;
3429 case 9: /* LOG100 */
3430 decParm->hdr.signal_type |= (9<<8);
3431 break;
3432 case 10: /* LOG316 */
3433 decParm->hdr.signal_type |= (10<<8);
3434 break;
3435 case 12: /* BT2020_12 */
3436 decParm->hdr.signal_type |= (15<<8);
3437 break;
3438 case 11: /* BT2020_10 */
3439 decParm->hdr.signal_type |= (14<<8);
3440 break;
3441 case 13: /* SMPTE2084 */
3442 decParm->hdr.signal_type |= (16<<8);
3443 break;
3444 case 14: /* ARIB_STD_B67 */
3445 decParm->hdr.signal_type |= (18<<8);
3446 break;
3447 #if ((GST_VERSION_MAJOR == 1) && (GST_VERSION_MINOR >= 18))
3448 case 16: /* BT601 */
3449 decParm->hdr.signal_type |= (3<<8);
3450 break;
3451 #endif
3452 case 1: /* GAMMA10 */
3453 case 2: /* GAMMA18 */
3454 case 3: /* GAMMA20 */
3455 case 4: /* GAMMA22 */
3456 case 7: /* SRGB */
3457 case 8: /* GAMMA28 */
3458 case 15: /* ADOBERGB */
3459 default:
3460 break;
3461 }
3462 /* primaries */
3463 switch ( hdrColorimetry[3] )
3464 {
3465 case 1: /* BT709 */
3466 decParm->hdr.signal_type |= ((1<<24)|(1<<16));
3467 break;
3468 case 2: /* BT470M */
3469 decParm->hdr.signal_type |= ((1<<24)|(4<<16));
3470 break;
3471 case 3: /* BT470BG */
3472 decParm->hdr.signal_type |= ((1<<24)|(5<<16));
3473 break;
3474 case 4: /* SMPTE170M */
3475 decParm->hdr.signal_type |= ((1<<24)|(6<<16));
3476 break;
3477 case 5: /* SMPTE240M */
3478 decParm->hdr.signal_type |= ((1<<24)|(7<<16));
3479 break;
3480 case 6: /* FILM */
3481 decParm->hdr.signal_type |= ((1<<24)|(8<<16));
3482 break;
3483 case 7: /* BT2020 */
3484 decParm->hdr.signal_type |= ((1<<24)|(9<<16));
3485 break;
3486 case 8: /* ADOBERGB */
3487 default:
3488 break;
3489 }
3490 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "HDR signal_type %X", decParm->hdr.signal_type);
3491 }
3492
3493 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "got caps %" GST_PTR_FORMAT, caps);
3494 GstStructure *st = gst_caps_get_structure(caps, 0);
3495 GstCapsFeatures *features = gst_caps_get_features(caps, 0);
3496
3497 if (gst_structure_has_field(st, "colorimetry"))
3498 {
3499 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "have colorimetry");
3500 }
3501
3502 if (st && features)
3503 {
3504 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "trace in remove colorimetry");
3505 gst_structure_remove_field(st, "colorimetry");
3506 gst_caps_features_remove(features, "colorimetry");
3507 }
3508 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "caps after remove colorimetry %" GST_PTR_FORMAT, caps);
3509 }
3510
3511 if ( gst_structure_has_field(structure, "mastering-display-metadata") )
3512 {
3513 const char *masteringDisplay= gst_structure_get_string(structure,"mastering-display-metadata");
3514 float hdrMasteringDisplay[10];
3515 if ( masteringDisplay && sscanf( masteringDisplay, "%f:%f:%f:%f:%f:%f:%f:%f:%f:%f",
3516 &hdrMasteringDisplay[0],
3517 &hdrMasteringDisplay[1],
3518 &hdrMasteringDisplay[2],
3519 &hdrMasteringDisplay[3],
3520 &hdrMasteringDisplay[4],
3521 &hdrMasteringDisplay[5],
3522 &hdrMasteringDisplay[6],
3523 &hdrMasteringDisplay[7],
3524 &hdrMasteringDisplay[8],
3525 &hdrMasteringDisplay[9] ) == 10 )
3526 {
3527 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "mastering display [%f,%f,%f,%f,%f,%f,%f,%f,%f,%f]",
3528 hdrMasteringDisplay[0],
3529 hdrMasteringDisplay[1],
3530 hdrMasteringDisplay[2],
3531 hdrMasteringDisplay[3],
3532 hdrMasteringDisplay[4],
3533 hdrMasteringDisplay[5],
3534 hdrMasteringDisplay[6],
3535 hdrMasteringDisplay[7],
3536 hdrMasteringDisplay[8],
3537 hdrMasteringDisplay[9] );
3538
3539 decParm->hdr.color_parms.present_flag= 1;
3540 decParm->hdr.color_parms.primaries[2][0]= (uint32_t)(hdrMasteringDisplay[0]*50000); /* R.x */
3541 decParm->hdr.color_parms.primaries[2][1]= (uint32_t)(hdrMasteringDisplay[1]*50000); /* R.y */
3542 decParm->hdr.color_parms.primaries[0][0]= (uint32_t)(hdrMasteringDisplay[2]*50000); /* G.x */
3543 decParm->hdr.color_parms.primaries[0][1]= (uint32_t)(hdrMasteringDisplay[3]*50000); /* G.y */
3544 decParm->hdr.color_parms.primaries[1][0]= (uint32_t)(hdrMasteringDisplay[4]*50000); /* B.x */
3545 decParm->hdr.color_parms.primaries[1][1]= (uint32_t)(hdrMasteringDisplay[5]*50000); /* B.y */
3546 decParm->hdr.color_parms.white_point[0]= (uint32_t)(hdrMasteringDisplay[6]*50000);
3547 decParm->hdr.color_parms.white_point[1]= (uint32_t)(hdrMasteringDisplay[7]*50000);
3548 decParm->hdr.color_parms.luminance[0]= (uint32_t)(hdrMasteringDisplay[8]);
3549 decParm->hdr.color_parms.luminance[1]= (uint32_t)(hdrMasteringDisplay[9]);
3550 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "HDR mastering: primaries %X %X %X %X %X %X",
3551 decParm->hdr.color_parms.primaries[2][0],
3552 decParm->hdr.color_parms.primaries[2][1],
3553 decParm->hdr.color_parms.primaries[0][0],
3554 decParm->hdr.color_parms.primaries[0][1],
3555 decParm->hdr.color_parms.primaries[1][0],
3556 decParm->hdr.color_parms.primaries[1][1] );
3557 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "HDR mastering: white point: %X %X",
3558 decParm->hdr.color_parms.white_point[0],
3559 decParm->hdr.color_parms.white_point[1] );
3560 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "HDR mastering: luminance: %X %X",
3561 decParm->hdr.color_parms.luminance[0],
3562 decParm->hdr.color_parms.luminance[1] );
3563 }
3564
3565 GstStructure *st = gst_caps_get_structure(caps, 0);
3566 GstCapsFeatures * features = gst_caps_get_features(caps, 0);
3567 if (st && features)
3568 {
3569 gst_structure_remove_fields(st, "mastering-display-metadata", NULL);
3570 gst_caps_features_remove(features, "mastering-display-metadata");
3571 }
3572 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "caps after remove mastering-display-metadata %" GST_PTR_FORMAT, caps);
3573 }
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]3574 }
3575}
3576
3577static gboolean
3578gst_aml_v4l2_object_set_format_full(GstAmlV4l2Object *v4l2object, GstCaps *caps,
3579 gboolean try_only, GstAmlV4l2Error *error)
3580{
3581 gint fd = v4l2object->video_fd;
3582 struct v4l2_format format;
3583 struct v4l2_streamparm streamparm;
3584 enum v4l2_field field;
3585 guint32 pixelformat;
3586 struct v4l2_fmtdesc *fmtdesc;
3587 GstVideoInfo info;
3588 GstVideoAlignment align;
3589 gint width, height, fps_n, fps_d;
3590 gint n_v4l_planes;
3591 gint i = 0;
3592 gboolean is_mplane;
3593 enum v4l2_colorspace colorspace = 0;
3594 enum v4l2_quantization range = 0;
3595 enum v4l2_ycbcr_encoding matrix = 0;
3596 enum v4l2_xfer_func transfer = 0;
3597 GstStructure *s;
3598 gboolean disable_colorimetry = FALSE;
3599
3600 g_return_val_if_fail(!v4l2object->skip_try_fmt_probes ||
3601 gst_caps_is_writable(caps),
3602 FALSE);
3603
3604 GST_AML_V4L2_CHECK_OPEN(v4l2object);
3605 if (!try_only)
3606 GST_AML_V4L2_CHECK_NOT_ACTIVE(v4l2object);
3607
3608 memset(&streamparm, 0x00, sizeof(struct v4l2_streamparm));
3609 streamparm.type = v4l2object->type;
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]3610 set_amlogic_vdec_parm(v4l2object, &streamparm, caps);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]3611
3612 is_mplane = V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type);
3613
3614 gst_video_info_init(&info);
3615 gst_video_alignment_reset(&align);
3616
3617 if (!gst_aml_v4l2_object_get_caps_info(v4l2object, caps, &fmtdesc, &info))
3618 goto invalid_caps;
3619
3620 pixelformat = fmtdesc->pixelformat;
3621 width = GST_VIDEO_INFO_WIDTH(&info);
3622 height = GST_VIDEO_INFO_HEIGHT(&info);
3623 fps_n = GST_VIDEO_INFO_FPS_N(&info);
3624 fps_d = GST_VIDEO_INFO_FPS_D(&info);
3625
3626 /* if encoded format (GST_VIDEO_INFO_N_PLANES return 0)
3627 * or if contiguous is prefered */
3628 n_v4l_planes = GST_VIDEO_INFO_N_PLANES(&info);
3629 if (!n_v4l_planes || !v4l2object->prefered_non_contiguous)
3630 n_v4l_planes = 1;
3631
3632 if (GST_VIDEO_INFO_IS_INTERLACED(&info))
3633 {
3634 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "interlaced video");
3635 /* ideally we would differentiate between types of interlaced video
3636 * but there is not sufficient information in the caps..
3637 */
3638 field = V4L2_FIELD_INTERLACED;
3639 }
3640 else
3641 {
3642 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "progressive video");
3643 field = V4L2_FIELD_NONE;
3644 }
3645
3646 /* We first pick the main colorspace from the primaries */
3647 switch (info.colorimetry.primaries)
3648 {
3649 case GST_VIDEO_COLOR_PRIMARIES_BT709:
3650 /* There is two colorspaces using these primaries, use the range to
3651 * differentiate */
3652 if (info.colorimetry.range == GST_VIDEO_COLOR_RANGE_16_235)
3653 colorspace = V4L2_COLORSPACE_REC709;
3654 else
3655 colorspace = V4L2_COLORSPACE_SRGB;
3656 break;
3657 case GST_VIDEO_COLOR_PRIMARIES_BT2020:
3658 colorspace = V4L2_COLORSPACE_BT2020;
3659 break;
3660 case GST_VIDEO_COLOR_PRIMARIES_BT470M:
3661 colorspace = V4L2_COLORSPACE_470_SYSTEM_M;
3662 break;
3663 case GST_VIDEO_COLOR_PRIMARIES_BT470BG:
3664 colorspace = V4L2_COLORSPACE_470_SYSTEM_BG;
3665 break;
3666 case GST_VIDEO_COLOR_PRIMARIES_SMPTE170M:
3667 colorspace = V4L2_COLORSPACE_SMPTE170M;
3668 break;
3669 case GST_VIDEO_COLOR_PRIMARIES_SMPTE240M:
3670 colorspace = V4L2_COLORSPACE_SMPTE240M;
3671 break;
3672
3673 case GST_VIDEO_COLOR_PRIMARIES_FILM:
3674 case GST_VIDEO_COLOR_PRIMARIES_UNKNOWN:
3675 /* We don't know, we will guess */
3676 break;
3677
3678 default:
3679 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3680 "Unknown colorimetry primaries %d", info.colorimetry.primaries);
3681 break;
3682 }
3683
3684 switch (info.colorimetry.range)
3685 {
3686 case GST_VIDEO_COLOR_RANGE_0_255:
3687 range = V4L2_QUANTIZATION_FULL_RANGE;
3688 break;
3689 case GST_VIDEO_COLOR_RANGE_16_235:
3690 range = V4L2_QUANTIZATION_LIM_RANGE;
3691 break;
3692 case GST_VIDEO_COLOR_RANGE_UNKNOWN:
3693 /* We let the driver pick a default one */
3694 break;
3695 default:
3696 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3697 "Unknown colorimetry range %d", info.colorimetry.range);
3698 break;
3699 }
3700
3701 switch (info.colorimetry.matrix)
3702 {
3703 case GST_VIDEO_COLOR_MATRIX_RGB:
3704 /* Unspecified, leave to default */
3705 break;
3706 /* FCC is about the same as BT601 with less digit */
3707 case GST_VIDEO_COLOR_MATRIX_FCC:
3708 case GST_VIDEO_COLOR_MATRIX_BT601:
3709 matrix = V4L2_YCBCR_ENC_601;
3710 break;
3711 case GST_VIDEO_COLOR_MATRIX_BT709:
3712 matrix = V4L2_YCBCR_ENC_709;
3713 break;
3714 case GST_VIDEO_COLOR_MATRIX_SMPTE240M:
3715 matrix = V4L2_YCBCR_ENC_SMPTE240M;
3716 break;
3717 case GST_VIDEO_COLOR_MATRIX_BT2020:
3718 matrix = V4L2_YCBCR_ENC_BT2020;
3719 break;
3720 case GST_VIDEO_COLOR_MATRIX_UNKNOWN:
3721 /* We let the driver pick a default one */
3722 break;
3723 default:
3724 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3725 "Unknown colorimetry matrix %d", info.colorimetry.matrix);
3726 break;
3727 }
3728
3729 switch (info.colorimetry.transfer)
3730 {
3731 case GST_VIDEO_TRANSFER_GAMMA18:
3732 case GST_VIDEO_TRANSFER_GAMMA20:
3733 case GST_VIDEO_TRANSFER_GAMMA22:
3734 case GST_VIDEO_TRANSFER_GAMMA28:
3735 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3736 "GAMMA 18, 20, 22, 28 transfer functions not supported");
3737 /* fallthrough */
3738 case GST_VIDEO_TRANSFER_GAMMA10:
3739 transfer = V4L2_XFER_FUNC_NONE;
3740 break;
3741 case GST_VIDEO_TRANSFER_BT2020_12:
3742 case GST_VIDEO_TRANSFER_BT709:
3743 transfer = V4L2_XFER_FUNC_709;
3744 break;
3745 case GST_VIDEO_TRANSFER_SMPTE240M:
3746 transfer = V4L2_XFER_FUNC_SMPTE240M;
3747 break;
3748 case GST_VIDEO_TRANSFER_SRGB:
3749 transfer = V4L2_XFER_FUNC_SRGB;
3750 break;
3751 case GST_VIDEO_TRANSFER_LOG100:
3752 case GST_VIDEO_TRANSFER_LOG316:
3753 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3754 "LOG 100, 316 transfer functions not supported");
3755 /* FIXME No known sensible default, maybe AdobeRGB ? */
3756 break;
3757 case GST_VIDEO_TRANSFER_UNKNOWN:
3758 /* We let the driver pick a default one */
3759 break;
3760 default:
3761 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3762 "Unknown colorimetry tranfer %d", info.colorimetry.transfer);
3763 break;
3764 }
3765
3766 if (colorspace == 0)
3767 {
3768 /* Try to guess colorspace according to pixelformat and size */
3769 if (GST_VIDEO_INFO_IS_YUV(&info))
3770 {
3771 if (range == V4L2_QUANTIZATION_FULL_RANGE && matrix == V4L2_YCBCR_ENC_601 && transfer == 0)
3772 {
3773 /* Full range BT.601 YCbCr encoding with unknown primaries and transfer
3774 * function most likely is JPEG */
3775 colorspace = V4L2_COLORSPACE_JPEG;
3776 transfer = V4L2_XFER_FUNC_SRGB;
3777 }
3778 else
3779 {
3780 /* SD streams likely use SMPTE170M and HD streams REC709 */
3781 if (width <= 720 && height <= 576)
3782 colorspace = V4L2_COLORSPACE_SMPTE170M;
3783 else
3784 colorspace = V4L2_COLORSPACE_REC709;
3785 }
3786 }
3787 else if (GST_VIDEO_INFO_IS_RGB(&info))
3788 {
3789 colorspace = V4L2_COLORSPACE_SRGB;
3790 transfer = V4L2_XFER_FUNC_NONE;
3791 }
3792 }
3793
3794 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Desired format %dx%d, format "
3795 "%" GST_FOURCC_FORMAT " stride: %d",
3796 width, height,
3797 GST_FOURCC_ARGS(pixelformat), GST_VIDEO_INFO_PLANE_STRIDE(&info, 0));
3798
3799 memset(&format, 0x00, sizeof(struct v4l2_format));
3800 format.type = v4l2object->type;
3801
3802 if (is_mplane)
3803 {
3804 format.type = v4l2object->type;
3805 format.fmt.pix_mp.pixelformat = pixelformat;
3806 format.fmt.pix_mp.width = width;
3807 format.fmt.pix_mp.height = height;
3808 format.fmt.pix_mp.field = field;
3809 format.fmt.pix_mp.num_planes = n_v4l_planes;
3810
3811 /* try to ask our prefered stride but it's not a failure if not
3812 * accepted */
3813 for (i = 0; i < n_v4l_planes; i++)
3814 {
3815 gint stride = GST_VIDEO_INFO_PLANE_STRIDE(&info, i);
3816
3817 if (GST_VIDEO_FORMAT_INFO_IS_TILED(info.finfo))
3818 stride = GST_VIDEO_TILE_X_TILES(stride) << GST_VIDEO_FORMAT_INFO_TILE_WS(info.finfo);
3819
3820 format.fmt.pix_mp.plane_fmt[i].bytesperline = stride;
3821 }
3822
3823 if (GST_VIDEO_INFO_FORMAT(&info) == GST_VIDEO_FORMAT_ENCODED)
3824 {
3825 if (v4l2object->req_mode == GST_V4L2_IO_DMABUF_IMPORT)
3826 format.fmt.pix_mp.plane_fmt[0].sizeimage = 1;
3827 else
3828 format.fmt.pix_mp.plane_fmt[0].sizeimage = ENCODED_BUFFER_SIZE;
3829 }
3830 }
3831 else
3832 {
3833 gint stride = GST_VIDEO_INFO_PLANE_STRIDE(&info, 0);
3834
3835 format.type = v4l2object->type;
3836
3837 format.fmt.pix.width = width;
3838 format.fmt.pix.height = height;
3839 format.fmt.pix.pixelformat = pixelformat;
3840 format.fmt.pix.field = field;
3841
3842 if (GST_VIDEO_FORMAT_INFO_IS_TILED(info.finfo))
3843 stride = GST_VIDEO_TILE_X_TILES(stride) << GST_VIDEO_FORMAT_INFO_TILE_WS(info.finfo);
3844
3845 /* try to ask our prefered stride */
3846 format.fmt.pix.bytesperline = stride;
3847
3848 if (GST_VIDEO_INFO_FORMAT(&info) == GST_VIDEO_FORMAT_ENCODED)
3849 {
3850 if (v4l2object->req_mode == GST_V4L2_IO_DMABUF_IMPORT)
3851 format.fmt.pix_mp.plane_fmt[0].sizeimage = 1;
3852 else
3853 format.fmt.pix_mp.plane_fmt[0].sizeimage = ENCODED_BUFFER_SIZE;
3854 }
3855 }
3856
3857 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Desired format is %dx%d, format "
3858 "%" GST_FOURCC_FORMAT ", nb planes %d",
3859 format.fmt.pix.width,
3860 format.fmt.pix_mp.height,
3861 GST_FOURCC_ARGS(format.fmt.pix.pixelformat),
3862 is_mplane ? format.fmt.pix_mp.num_planes : 1);
3863
3864#ifndef GST_DISABLE_GST_DEBUG
3865 if (is_mplane)
3866 {
3867 for (i = 0; i < format.fmt.pix_mp.num_planes; i++)
3868 GST_DEBUG_OBJECT(v4l2object->dbg_obj, " stride %d",
3869 format.fmt.pix_mp.plane_fmt[i].bytesperline);
3870 }
3871 else
3872 {
3873 GST_DEBUG_OBJECT(v4l2object->dbg_obj, " stride %d",
3874 format.fmt.pix.bytesperline);
3875 }
3876#endif
3877
3878 if (is_mplane)
3879 {
3880 format.fmt.pix_mp.colorspace = colorspace;
3881 format.fmt.pix_mp.quantization = range;
3882 format.fmt.pix_mp.ycbcr_enc = matrix;
3883 format.fmt.pix_mp.xfer_func = transfer;
3884 }
3885 else
3886 {
3887 format.fmt.pix.priv = V4L2_PIX_FMT_PRIV_MAGIC;
3888 format.fmt.pix.colorspace = colorspace;
3889 format.fmt.pix.quantization = range;
3890 format.fmt.pix.ycbcr_enc = matrix;
3891 format.fmt.pix.xfer_func = transfer;
3892 }
3893
3894 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Desired colorspace is %d:%d:%d:%d",
3895 colorspace, range, matrix, transfer);
3896
3897 if (try_only)
3898 {
3899 if (v4l2object->ioctl(fd, VIDIOC_TRY_FMT, &format) < 0)
3900 goto try_fmt_failed;
3901 }
3902 else
3903 {
3904 if (v4l2object->ioctl(fd, VIDIOC_S_FMT, &format) < 0)
3905 goto set_fmt_failed;
3906 }
3907
3908 if (is_mplane)
3909 {
3910 colorspace = format.fmt.pix_mp.colorspace;
3911 range = format.fmt.pix_mp.quantization;
3912 matrix = format.fmt.pix_mp.ycbcr_enc;
3913 transfer = format.fmt.pix_mp.xfer_func;
3914 }
3915 else
3916 {
3917 colorspace = format.fmt.pix.colorspace;
3918 range = format.fmt.pix.quantization;
3919 matrix = format.fmt.pix.ycbcr_enc;
3920 transfer = format.fmt.pix.xfer_func;
3921 }
3922
3923 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Got format of %dx%d, format "
3924 "%" GST_FOURCC_FORMAT ", nb planes %d, colorspace %d:%d:%d:%d",
3925 format.fmt.pix.width, format.fmt.pix_mp.height,
3926 GST_FOURCC_ARGS(format.fmt.pix.pixelformat),
3927 is_mplane ? format.fmt.pix_mp.num_planes : 1,
3928 colorspace, range, matrix, transfer);
3929
3930#ifndef GST_DISABLE_GST_DEBUG
3931 if (is_mplane)
3932 {
3933 for (i = 0; i < format.fmt.pix_mp.num_planes; i++)
3934 GST_DEBUG_OBJECT(v4l2object->dbg_obj, " stride %d, sizeimage %d",
3935 format.fmt.pix_mp.plane_fmt[i].bytesperline,
3936 format.fmt.pix_mp.plane_fmt[i].sizeimage);
3937 }
3938 else
3939 {
3940 GST_DEBUG_OBJECT(v4l2object->dbg_obj, " stride %d, sizeimage %d",
3941 format.fmt.pix.bytesperline, format.fmt.pix.sizeimage);
3942 }
3943#endif
3944
3945 if (format.fmt.pix.pixelformat != pixelformat)
3946 goto invalid_pixelformat;
3947
3948 /* Only negotiate size with raw data.
3949 * For some codecs the dimensions are *not* in the bitstream, IIRC VC1
3950 * in ASF mode for example, there is also not reason for a driver to
3951 * change the size. */
3952 if (info.finfo->format != GST_VIDEO_FORMAT_ENCODED)
3953 {
3954 /* We can crop larger images */
3955 if (format.fmt.pix.width < width || format.fmt.pix.height < height)
3956 goto invalid_dimensions;
3957
3958 /* Note, this will be adjusted if upstream has non-centered cropping. */
3959 align.padding_top = 0;
3960 align.padding_bottom = format.fmt.pix.height - height;
3961 align.padding_left = 0;
3962 align.padding_right = format.fmt.pix.width - width;
3963 }
3964
3965 if (is_mplane && format.fmt.pix_mp.num_planes != n_v4l_planes)
3966 goto invalid_planes;
3967
3968 /* used to check colorimetry and interlace mode fields presence */
3969 s = gst_caps_get_structure(caps, 0);
3970
3971 if (!gst_aml_v4l2_object_get_interlace_mode(format.fmt.pix.field,
3972 &info.interlace_mode))
3973 goto invalid_field;
3974 if (gst_structure_has_field(s, "interlace-mode"))
3975 {
3976 if (format.fmt.pix.field != field)
3977 goto invalid_field;
3978 }
3979
3980 if (gst_aml_v4l2_object_get_colorspace(&format, &info.colorimetry))
3981 {
3982 if (gst_structure_has_field(s, "colorimetry"))
3983 {
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]3984 if (!gst_aml_v4l2_video_colorimetry_matches(&info.colorimetry, gst_structure_get_string(s, "colorimetry")))
3985 {
3986 // goto invalid_colorimetry;
3987 }
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]3988 }
3989 }
3990 else
3991 {
3992 /* The driver (or libv4l2) is miss-behaving, just ignore colorimetry from
3993 * the TRY_FMT */
3994 disable_colorimetry = TRUE;
3995 if (gst_structure_has_field(s, "colorimetry"))
3996 gst_structure_remove_field(s, "colorimetry");
3997 }
3998
3999 /* In case we have skipped the try_fmt probes, we'll need to set the
4000 * colorimetry and interlace-mode back into the caps. */
4001 if (v4l2object->skip_try_fmt_probes)
4002 {
4003 if (!disable_colorimetry && !gst_structure_has_field(s, "colorimetry"))
4004 {
4005 gchar *str = gst_video_colorimetry_to_string(&info.colorimetry);
4006 gst_structure_set(s, "colorimetry", G_TYPE_STRING, str, NULL);
4007 g_free(str);
4008 }
4009
4010 if (!gst_structure_has_field(s, "interlace-mode"))
4011 gst_structure_set(s, "interlace-mode", G_TYPE_STRING,
4012 gst_video_interlace_mode_to_string(info.interlace_mode), NULL);
4013 }
4014
4015 if (try_only) /* good enough for trying only */
4016 return TRUE;
4017
4018 if (GST_VIDEO_INFO_HAS_ALPHA(&info))
4019 {
4020 struct v4l2_control ctl = {
4021 0,
4022 };
4023 ctl.id = V4L2_CID_ALPHA_COMPONENT;
4024 ctl.value = 0xff;
4025
4026 if (v4l2object->ioctl(fd, VIDIOC_S_CTRL, &ctl) < 0)
4027 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4028 "Failed to set alpha component value");
4029 }
4030
4031 /* Is there a reason we require the caller to always specify a framerate? */
4032 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Desired framerate: %u/%u", fps_n,
4033 fps_d);
4034
4035 if (v4l2object->ioctl(fd, VIDIOC_G_PARM, &streamparm) < 0)
4036 goto get_parm_failed;
4037
4038 if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE || v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
4039 {
4040 GST_VIDEO_INFO_FPS_N(&info) =
4041 streamparm.parm.capture.timeperframe.denominator;
4042 GST_VIDEO_INFO_FPS_D(&info) =
4043 streamparm.parm.capture.timeperframe.numerator;
4044
4045 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Got capture framerate: %u/%u",
4046 streamparm.parm.capture.timeperframe.denominator,
4047 streamparm.parm.capture.timeperframe.numerator);
4048
4049 /* We used to skip frame rate setup if the camera was already setup
4050 * with the requested frame rate. This breaks some cameras though,
4051 * causing them to not output data (several models of Thinkpad cameras
4052 * have this problem at least).
4053 * So, don't skip. */
4054 GST_LOG_OBJECT(v4l2object->dbg_obj, "Setting capture framerate to %u/%u",
4055 fps_n, fps_d);
4056 /* We want to change the frame rate, so check whether we can. Some cheap USB
4057 * cameras don't have the capability */
4058 if ((streamparm.parm.capture.capability & V4L2_CAP_TIMEPERFRAME) == 0)
4059 {
4060 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
4061 "Not setting capture framerate (not supported)");
4062 goto done;
4063 }
4064
4065 /* Note: V4L2 wants the frame interval, we have the frame rate */
4066 streamparm.parm.capture.timeperframe.numerator = fps_d;
4067 streamparm.parm.capture.timeperframe.denominator = fps_n;
4068
4069 /* some cheap USB cam's won't accept any change */
4070 if (v4l2object->ioctl(fd, VIDIOC_S_PARM, &streamparm) < 0)
4071 goto set_parm_failed;
4072
4073 if (streamparm.parm.capture.timeperframe.numerator > 0 &&
4074 streamparm.parm.capture.timeperframe.denominator > 0)
4075 {
4076 /* get new values */
4077 fps_d = streamparm.parm.capture.timeperframe.numerator;
4078 fps_n = streamparm.parm.capture.timeperframe.denominator;
4079
4080 GST_INFO_OBJECT(v4l2object->dbg_obj, "Set capture framerate to %u/%u",
4081 fps_n, fps_d);
4082 }
4083 else
4084 {
4085 /* fix v4l2 capture driver to provide framerate values */
4086 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4087 "Reuse caps framerate %u/%u - fix v4l2 capture driver", fps_n, fps_d);
4088 }
4089
4090 GST_VIDEO_INFO_FPS_N(&info) = fps_n;
4091 GST_VIDEO_INFO_FPS_D(&info) = fps_d;
4092 }
4093 else if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT || v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
4094 {
4095 GST_VIDEO_INFO_FPS_N(&info) =
4096 streamparm.parm.output.timeperframe.denominator;
4097 GST_VIDEO_INFO_FPS_D(&info) =
4098 streamparm.parm.output.timeperframe.numerator;
4099
4100 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Got output framerate: %u/%u",
4101 streamparm.parm.output.timeperframe.denominator,
4102 streamparm.parm.output.timeperframe.numerator);
4103
4104 GST_LOG_OBJECT(v4l2object->dbg_obj, "Setting output framerate to %u/%u",
4105 fps_n, fps_d);
4106 if ((streamparm.parm.output.capability & V4L2_CAP_TIMEPERFRAME) == 0)
4107 {
4108 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
4109 "Not setting output framerate (not supported)");
4110 goto done;
4111 }
4112
4113 /* Note: V4L2 wants the frame interval, we have the frame rate */
4114 streamparm.parm.output.timeperframe.numerator = fps_d;
4115 streamparm.parm.output.timeperframe.denominator = fps_n;
4116
4117 if (v4l2object->ioctl(fd, VIDIOC_S_PARM, &streamparm) < 0)
4118 goto set_parm_failed;
4119
4120 if (streamparm.parm.output.timeperframe.numerator > 0 &&
4121 streamparm.parm.output.timeperframe.denominator > 0)
4122 {
4123 /* get new values */
4124 fps_d = streamparm.parm.output.timeperframe.numerator;
4125 fps_n = streamparm.parm.output.timeperframe.denominator;
4126
4127 GST_INFO_OBJECT(v4l2object->dbg_obj, "Set output framerate to %u/%u",
4128 fps_n, fps_d);
4129 }
4130 else
4131 {
4132 /* fix v4l2 output driver to provide framerate values */
4133 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4134 "Reuse caps framerate %u/%u - fix v4l2 output driver", fps_n, fps_d);
4135 }
4136
4137 GST_VIDEO_INFO_FPS_N(&info) = fps_n;
4138 GST_VIDEO_INFO_FPS_D(&info) = fps_d;
4139 }
4140
4141done:
4142 /* add boolean return, so we can fail on drivers bugs */
4143 gst_aml_v4l2_object_save_format(v4l2object, fmtdesc, &format, &info, &align);
4144
4145 /* now configure the pool */
4146 if (!gst_aml_v4l2_object_setup_pool(v4l2object, caps))
4147 goto pool_failed;
4148
4149 return TRUE;
4150
4151 /* ERRORS */
4152invalid_caps:
4153{
4154 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "can't parse caps %" GST_PTR_FORMAT,
4155 caps);
4156
4157 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4158 (_("Invalid caps")), ("Can't parse caps %" GST_PTR_FORMAT, caps));
4159 return FALSE;
4160}
4161try_fmt_failed:
4162{
4163 if (errno == EINVAL)
4164 {
4165 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4166 (_("Device '%s' has no supported format"), v4l2object->videodev),
4167 ("Call to TRY_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4168 GST_FOURCC_ARGS(pixelformat), width, height,
4169 g_strerror(errno)));
4170 }
4171 else
4172 {
4173 GST_AML_V4L2_ERROR(error, RESOURCE, FAILED,
4174 (_("Device '%s' failed during initialization"),
4175 v4l2object->videodev),
4176 ("Call to TRY_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4177 GST_FOURCC_ARGS(pixelformat), width, height,
4178 g_strerror(errno)));
4179 }
4180 return FALSE;
4181}
4182set_fmt_failed:
4183{
4184 if (errno == EBUSY)
4185 {
4186 GST_AML_V4L2_ERROR(error, RESOURCE, BUSY,
4187 (_("Device '%s' is busy"), v4l2object->videodev),
4188 ("Call to S_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4189 GST_FOURCC_ARGS(pixelformat), width, height,
4190 g_strerror(errno)));
4191 }
4192 else if (errno == EINVAL)
4193 {
4194 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4195 (_("Device '%s' has no supported format"), v4l2object->videodev),
4196 ("Call to S_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4197 GST_FOURCC_ARGS(pixelformat), width, height,
4198 g_strerror(errno)));
4199 }
4200 else
4201 {
4202 GST_AML_V4L2_ERROR(error, RESOURCE, FAILED,
4203 (_("Device '%s' failed during initialization"),
4204 v4l2object->videodev),
4205 ("Call to S_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4206 GST_FOURCC_ARGS(pixelformat), width, height,
4207 g_strerror(errno)));
4208 }
4209 return FALSE;
4210}
4211invalid_dimensions:
4212{
4213 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4214 (_("Device '%s' cannot capture at %dx%d"),
4215 v4l2object->videodev, width, height),
4216 ("Tried to capture at %dx%d, but device returned size %dx%d",
4217 width, height, format.fmt.pix.width, format.fmt.pix.height));
4218 return FALSE;
4219}
4220invalid_pixelformat:
4221{
4222 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4223 (_("Device '%s' cannot capture in the specified format"),
4224 v4l2object->videodev),
4225 ("Tried to capture in %" GST_FOURCC_FORMAT
4226 ", but device returned format"
4227 " %" GST_FOURCC_FORMAT,
4228 GST_FOURCC_ARGS(pixelformat),
4229 GST_FOURCC_ARGS(format.fmt.pix.pixelformat)));
4230 return FALSE;
4231}
4232invalid_planes:
4233{
4234 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4235 (_("Device '%s' does support non-contiguous planes"),
4236 v4l2object->videodev),
4237 ("Device wants %d planes", format.fmt.pix_mp.num_planes));
4238 return FALSE;
4239}
4240invalid_field:
4241{
4242 enum v4l2_field wanted_field;
4243
4244 if (is_mplane)
4245 wanted_field = format.fmt.pix_mp.field;
4246 else
4247 wanted_field = format.fmt.pix.field;
4248
4249 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4250 (_("Device '%s' does not support %s interlacing"),
4251 v4l2object->videodev,
4252 field == V4L2_FIELD_NONE ? "progressive" : "interleaved"),
4253 ("Device wants %s interlacing",
4254 wanted_field == V4L2_FIELD_NONE ? "progressive" : "interleaved"));
4255 return FALSE;
4256}
4257invalid_colorimetry:
4258{
4259 gchar *wanted_colorimetry;
4260
4261 wanted_colorimetry = gst_video_colorimetry_to_string(&info.colorimetry);
4262
4263 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4264 (_("Device '%s' does not support %s colorimetry"),
4265 v4l2object->videodev, gst_structure_get_string(s, "colorimetry")),
4266 ("Device wants %s colorimetry", wanted_colorimetry));
4267
4268 g_free(wanted_colorimetry);
4269 return FALSE;
4270}
4271get_parm_failed:
4272{
4273 /* it's possible that this call is not supported */
4274 if (errno != EINVAL && errno != ENOTTY)
4275 {
4276 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4277 (_("Could not get parameters on device '%s'"),
4278 v4l2object->videodev),
4279 GST_ERROR_SYSTEM);
4280 }
4281 goto done;
4282}
4283set_parm_failed:
4284{
4285 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4286 (_("Video device did not accept new frame rate setting.")),
4287 GST_ERROR_SYSTEM);
4288 goto done;
4289}
4290pool_failed:
4291{
4292 /* setup_pool already send the error */
4293 return FALSE;
4294}
4295}
4296
4297gboolean
4298gst_aml_v4l2_object_set_format(GstAmlV4l2Object *v4l2object, GstCaps *caps,
4299 GstAmlV4l2Error *error)
4300{
4301 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Setting format to %" GST_PTR_FORMAT,
4302 caps);
4303 return gst_aml_v4l2_object_set_format_full(v4l2object, caps, FALSE, error);
4304}
4305
4306gboolean
4307gst_aml_v4l2_object_try_format(GstAmlV4l2Object *v4l2object, GstCaps *caps,
4308 GstAmlV4l2Error *error)
4309{
4310 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Trying format %" GST_PTR_FORMAT,
4311 caps);
4312 return gst_aml_v4l2_object_set_format_full(v4l2object, caps, TRUE, error);
4313}
4314
4315GstFlowReturn
4316gst_aml_v4l2_object_poll(GstAmlV4l2Object *v4l2object)
4317{
4318 gint ret;
4319
4320 if (!v4l2object->can_poll_device)
4321 goto done;
4322
4323 GST_LOG_OBJECT(v4l2object, "polling device");
4324
4325again:
4326 ret = gst_poll_wait(v4l2object->poll, GST_CLOCK_TIME_NONE);
4327 if (G_UNLIKELY(ret < 0))
4328 {
4329 switch (errno)
4330 {
4331 case EBUSY:
4332 goto stopped;
4333 case EAGAIN:
4334 case EINTR:
4335 goto again;
4336 case ENXIO:
4337 GST_WARNING_OBJECT(v4l2object,
4338 "v4l2 device doesn't support polling. Disabling"
4339 " using libv4l2 in this case may cause deadlocks");
4340 v4l2object->can_poll_device = FALSE;
4341 goto done;
4342 default:
4343 goto select_error;
4344 }
4345 }
4346
4347done:
4348 return GST_FLOW_OK;
4349
4350 /* ERRORS */
4351stopped:
4352{
4353 GST_DEBUG_OBJECT(v4l2object, "stop called");
4354 return GST_FLOW_FLUSHING;
4355}
4356select_error:
4357{
4358 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, READ, (NULL),
4359 ("poll error %d: %s (%d)", ret, g_strerror(errno), errno));
4360 return GST_FLOW_ERROR;
4361}
4362}
4363
4364GstFlowReturn
4365gst_aml_v4l2_object_dqevent(GstAmlV4l2Object *v4l2object)
4366{
4367 GstFlowReturn res;
4368 struct v4l2_event evt;
4369
4370 if ((res = gst_aml_v4l2_object_poll(v4l2object)) != GST_FLOW_OK)
4371 goto poll_failed;
4372
4373 memset(&evt, 0x00, sizeof(struct v4l2_event));
4374 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_DQEVENT, &evt) < 0)
4375 goto dqevent_failed;
4376
4377 switch (evt.type)
4378 {
4379 case V4L2_EVENT_SOURCE_CHANGE:
4380 return GST_AML_V4L2_FLOW_SOURCE_CHANGE;
4381 break;
4382 case V4L2_EVENT_EOS:
4383 return GST_AML_V4L2_FLOW_LAST_BUFFER;
4384 break;
4385 default:
4386 break;
4387 }
4388
4389 return GST_FLOW_OK;
4390
4391 /* ERRORS */
4392poll_failed:
4393{
4394 GST_DEBUG_OBJECT(v4l2object, "poll error %s", gst_flow_get_name(res));
4395 return res;
4396}
4397dqevent_failed:
4398{
4399 return GST_FLOW_ERROR;
4400}
4401}
4402
4403/**
4404 * gst_aml_v4l2_object_acquire_format:
4405 * @v4l2object the object
4406 * @info a GstVideoInfo to be filled
4407 *
4408 * Acquire the driver choosen format. This is useful in decoder or encoder elements where
4409 * the output format is choosen by the HW.
4410 *
4411 * Returns: %TRUE on success, %FALSE on failure.
4412 */
4413gboolean
4414gst_aml_v4l2_object_acquire_format(GstAmlV4l2Object *v4l2object, GstVideoInfo *info)
4415{
4416 struct v4l2_fmtdesc *fmtdesc;
4417 struct v4l2_format fmt;
4418 struct v4l2_crop crop;
4419 struct v4l2_selection sel;
4420 struct v4l2_rect *r = NULL;
4421 GstVideoFormat format;
4422 guint width, height;
4423 GstVideoAlignment align;
4424
4425 gst_video_info_init(info);
4426 gst_video_alignment_reset(&align);
4427
4428 memset(&fmt, 0x00, sizeof(struct v4l2_format));
4429 fmt.type = v4l2object->type;
4430 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_FMT, &fmt) < 0)
4431 goto get_fmt_failed;
4432
4433 fmtdesc = gst_aml_v4l2_object_get_format_from_fourcc(v4l2object,
4434 fmt.fmt.pix.pixelformat);
4435 if (fmtdesc == NULL)
4436 goto unsupported_format;
4437
4438 /* No need to care about mplane, the four first params are the same */
4439 format = gst_aml_v4l2_object_v4l2fourcc_to_video_format(fmt.fmt.pix.pixelformat);
4440
4441 /* fails if we do no translate the fmt.pix.pixelformat to GstVideoFormat */
4442 if (format == GST_VIDEO_FORMAT_UNKNOWN)
4443 goto unsupported_format;
4444
4445 if (fmt.fmt.pix.width == 0 || fmt.fmt.pix.height == 0)
4446 goto invalid_dimensions;
4447
4448 width = fmt.fmt.pix.width;
4449 height = fmt.fmt.pix.height;
4450
4451 /* Use the default compose rectangle */
4452 memset(&sel, 0, sizeof(struct v4l2_selection));
4453 sel.type = v4l2object->type;
4454 sel.target = V4L2_SEL_TGT_COMPOSE_DEFAULT;
4455 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_SELECTION, &sel) >= 0)
4456 {
4457 r = &sel.r;
4458 }
4459 else
4460 {
4461 /* For ancient kernels, fall back to G_CROP */
4462 memset(&crop, 0, sizeof(struct v4l2_crop));
4463 crop.type = v4l2object->type;
4464 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_CROP, &crop) >= 0)
4465 r = &crop.c;
4466 }
4467 if (r)
4468 {
4469 align.padding_left = r->left;
4470 align.padding_top = r->top;
4471 align.padding_right = width - r->width - r->left;
4472 align.padding_bottom = height - r->height - r->top;
4473 width = r->width;
4474 height = r->height;
4475 }
4476
4477 gst_video_info_set_format(info, format, width, height);
4478
4479 switch (fmt.fmt.pix.field)
4480 {
4481 case V4L2_FIELD_ANY:
4482 case V4L2_FIELD_NONE:
4483 info->interlace_mode = GST_VIDEO_INTERLACE_MODE_PROGRESSIVE;
4484 break;
4485 case V4L2_FIELD_INTERLACED:
4486 case V4L2_FIELD_INTERLACED_TB:
4487 case V4L2_FIELD_INTERLACED_BT:
4488 info->interlace_mode = GST_VIDEO_INTERLACE_MODE_INTERLEAVED;
4489 break;
4490 default:
4491 goto unsupported_field;
4492 }
4493
4494 gst_aml_v4l2_object_get_colorspace(&fmt, &info->colorimetry);
4495
4496 gst_aml_v4l2_object_save_format(v4l2object, fmtdesc, &fmt, info, &align);
4497
4498 /* Shall we setup the pool ? */
4499
4500 return TRUE;
4501
4502get_fmt_failed:
4503{
4504 GST_ELEMENT_WARNING(v4l2object->element, RESOURCE, SETTINGS,
4505 (_("Video device did not provide output format.")), GST_ERROR_SYSTEM);
4506 return FALSE;
4507}
4508invalid_dimensions:
4509{
4510 GST_ELEMENT_WARNING(v4l2object->element, RESOURCE, SETTINGS,
4511 (_("Video device returned invalid dimensions.")),
4512 ("Expected non 0 dimensions, got %dx%d", fmt.fmt.pix.width,
4513 fmt.fmt.pix.height));
4514 return FALSE;
4515}
4516unsupported_field:
4517{
4518 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, SETTINGS,
4519 (_("Video device uses an unsupported interlacing method.")),
4520 ("V4L2 field type %d not supported", fmt.fmt.pix.field));
4521 return FALSE;
4522}
4523unsupported_format:
4524{
4525 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, SETTINGS,
4526 (_("Video device uses an unsupported pixel format.")),
4527 ("V4L2 format %" GST_FOURCC_FORMAT " not supported",
4528 GST_FOURCC_ARGS(fmt.fmt.pix.pixelformat)));
4529 return FALSE;
4530}
4531}
4532
4533gboolean
4534gst_aml_v4l2_object_set_crop(GstAmlV4l2Object *obj)
4535{
4536 struct v4l2_selection sel = {0};
4537 struct v4l2_crop crop = {0};
4538
4539 sel.type = obj->type;
4540 sel.target = V4L2_SEL_TGT_CROP;
4541 sel.flags = 0;
4542 sel.r.left = obj->align.padding_left;
4543 sel.r.top = obj->align.padding_top;
4544 sel.r.width = obj->info.width;
4545 sel.r.height = obj->info.height;
4546
4547 crop.type = obj->type;
4548 crop.c = sel.r;
4549
4550 if (obj->align.padding_left + obj->align.padding_top +
4551 obj->align.padding_right + obj->align.padding_bottom ==
4552 0)
4553 {
4554 GST_DEBUG_OBJECT(obj->dbg_obj, "no cropping needed");
4555 return TRUE;
4556 }
4557
4558 GST_DEBUG_OBJECT(obj->dbg_obj,
4559 "Desired cropping left %u, top %u, size %ux%u", crop.c.left, crop.c.top,
4560 crop.c.width, crop.c.height);
4561
4562 if (obj->ioctl(obj->video_fd, VIDIOC_S_SELECTION, &sel) < 0)
4563 {
4564 if (errno != ENOTTY)
4565 {
4566 GST_WARNING_OBJECT(obj->dbg_obj,
4567 "Failed to set crop rectangle with VIDIOC_S_SELECTION: %s",
4568 g_strerror(errno));
4569 return FALSE;
4570 }
4571 else
4572 {
4573 if (obj->ioctl(obj->video_fd, VIDIOC_S_CROP, &crop) < 0)
4574 {
4575 GST_WARNING_OBJECT(obj->dbg_obj, "VIDIOC_S_CROP failed");
4576 return FALSE;
4577 }
4578
4579 if (obj->ioctl(obj->video_fd, VIDIOC_G_CROP, &crop) < 0)
4580 {
4581 GST_WARNING_OBJECT(obj->dbg_obj, "VIDIOC_G_CROP failed");
4582 return FALSE;
4583 }
4584
4585 sel.r = crop.c;
4586 }
4587 }
4588
4589 GST_DEBUG_OBJECT(obj->dbg_obj,
4590 "Got cropping left %u, top %u, size %ux%u", crop.c.left, crop.c.top,
4591 crop.c.width, crop.c.height);
4592
4593 return TRUE;
4594}
4595
4596gboolean
4597gst_aml_v4l2_object_caps_equal(GstAmlV4l2Object *v4l2object, GstCaps *caps)
4598{
4599 GstStructure *config;
4600 GstCaps *oldcaps;
4601 gboolean ret;
4602
4603 if (!v4l2object->pool)
4604 return FALSE;
4605
4606 config = gst_buffer_pool_get_config(v4l2object->pool);
4607 gst_buffer_pool_config_get_params(config, &oldcaps, NULL, NULL, NULL);
4608
4609 ret = oldcaps && gst_caps_is_equal(caps, oldcaps);
4610
4611 gst_structure_free(config);
4612
4613 return ret;
4614}
4615
4616gboolean
4617gst_aml_v4l2_object_caps_is_subset(GstAmlV4l2Object *v4l2object, GstCaps *caps)
4618{
4619 GstStructure *config;
4620 GstCaps *oldcaps;
4621 gboolean ret;
4622
4623 if (!v4l2object->pool)
4624 return FALSE;
4625
4626 config = gst_buffer_pool_get_config(v4l2object->pool);
4627 gst_buffer_pool_config_get_params(config, &oldcaps, NULL, NULL, NULL);
4628
4629 ret = oldcaps && gst_caps_is_subset(oldcaps, caps);
4630
4631 gst_structure_free(config);
4632
4633 return ret;
4634}
4635
4636GstCaps *
4637gst_aml_v4l2_object_get_current_caps(GstAmlV4l2Object *v4l2object)
4638{
4639 GstStructure *config;
4640 GstCaps *oldcaps;
4641
4642 if (!v4l2object->pool)
4643 return NULL;
4644
4645 config = gst_buffer_pool_get_config(v4l2object->pool);
4646 gst_buffer_pool_config_get_params(config, &oldcaps, NULL, NULL, NULL);
4647
4648 if (oldcaps)
4649 gst_caps_ref(oldcaps);
4650
4651 gst_structure_free(config);
4652
4653 return oldcaps;
4654}
4655
4656gboolean
4657gst_aml_v4l2_object_unlock(GstAmlV4l2Object *v4l2object)
4658{
4659 gboolean ret = TRUE;
4660
4661 GST_LOG_OBJECT(v4l2object->dbg_obj, "start flushing");
4662
4663 gst_poll_set_flushing(v4l2object->poll, TRUE);
4664
4665 if (v4l2object->pool && gst_buffer_pool_is_active(v4l2object->pool))
4666 gst_buffer_pool_set_flushing(v4l2object->pool, TRUE);
4667
4668 return ret;
4669}
4670
4671gboolean
4672gst_aml_v4l2_object_unlock_stop(GstAmlV4l2Object *v4l2object)
4673{
4674 gboolean ret = TRUE;
4675
4676 GST_LOG_OBJECT(v4l2object->dbg_obj, "stop flushing");
4677
4678 if (v4l2object->pool && gst_buffer_pool_is_active(v4l2object->pool))
4679 gst_buffer_pool_set_flushing(v4l2object->pool, FALSE);
4680
4681 gst_poll_set_flushing(v4l2object->poll, FALSE);
4682
4683 return ret;
4684}
4685
4686gboolean
4687gst_aml_v4l2_object_stop(GstAmlV4l2Object *v4l2object)
4688{
4689 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "stopping");
4690
4691 if (!GST_AML_V4L2_IS_OPEN(v4l2object))
4692 goto done;
4693 if (!GST_AML_V4L2_IS_ACTIVE(v4l2object))
4694 goto done;
4695
4696 if (v4l2object->pool)
4697 {
4698 if (!gst_aml_v4l2_buffer_pool_orphan(&v4l2object->pool))
4699 {
4700 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "deactivating pool");
4701 gst_buffer_pool_set_active(v4l2object->pool, FALSE);
4702 gst_object_unref(v4l2object->pool);
4703 }
4704 v4l2object->pool = NULL;
4705 }
4706
4707 GST_AML_V4L2_SET_INACTIVE(v4l2object);
4708
4709done:
4710 return TRUE;
4711}
4712
4713GstCaps *
4714gst_aml_v4l2_object_probe_caps(GstAmlV4l2Object *v4l2object, GstCaps *filter)
4715{
4716 GstCaps *ret;
4717 GSList *walk;
4718 GSList *formats;
4719
4720 formats = gst_aml_v4l2_object_get_format_list(v4l2object);
4721
4722 ret = gst_caps_new_empty();
4723
4724 if (v4l2object->keep_aspect && !v4l2object->par)
4725 {
4726 struct v4l2_cropcap cropcap;
4727
4728 memset(&cropcap, 0, sizeof(cropcap));
4729
4730 cropcap.type = v4l2object->type;
4731 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_CROPCAP, &cropcap) < 0)
4732 {
4733 if (errno != ENOTTY)
4734 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4735 "Failed to probe pixel aspect ratio with VIDIOC_CROPCAP: %s",
4736 g_strerror(errno));
4737 }
4738 else if (cropcap.pixelaspect.numerator && cropcap.pixelaspect.denominator)
4739 {
4740 v4l2object->par = g_new0(GValue, 1);
4741 g_value_init(v4l2object->par, GST_TYPE_FRACTION);
4742 gst_value_set_fraction(v4l2object->par, cropcap.pixelaspect.numerator,
4743 cropcap.pixelaspect.denominator);
4744 }
4745 }
4746
4747 for (walk = formats; walk; walk = walk->next)
4748 {
4749 struct v4l2_fmtdesc *format;
4750 GstStructure *template;
4751 GstCaps *tmp, *tmp2;
4752
4753 format = (struct v4l2_fmtdesc *)walk->data;
4754
4755 template = gst_aml_v4l2_object_v4l2fourcc_to_bare_struct(format->pixelformat);
4756
4757 if (!template)
4758 {
4759 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
4760 "unknown format %" GST_FOURCC_FORMAT,
4761 GST_FOURCC_ARGS(format->pixelformat));
4762 continue;
4763 }
4764
4765 /* If we have a filter, check if we need to probe this format or not */
4766 if (filter)
4767 {
4768 GstCaps *format_caps = gst_caps_new_empty();
4769
4770 gst_caps_append_structure(format_caps, gst_structure_copy(template));
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]4771 GST_INFO_OBJECT(v4l2object->dbg_obj, "format_caps: %" GST_PTR_FORMAT, format_caps);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]4772
4773 if (!gst_caps_can_intersect(format_caps, filter))
4774 {
4775 gst_caps_unref(format_caps);
4776 gst_structure_free(template);
4777 continue;
4778 }
4779
4780 gst_caps_unref(format_caps);
4781 }
4782
4783 tmp = gst_aml_v4l2_object_probe_caps_for_format(v4l2object,
4784 format->pixelformat, template);
xuesong.jiange1a19662022-06-21 20:30:22 +0800[diff] [blame]4785 GST_INFO_OBJECT(v4l2object->dbg_obj, "tmp caps: %" GST_PTR_FORMAT, tmp);
xuesong.jiangae1548e2022-05-06 16:38:46 +0800[diff] [blame]4786
4787 if (tmp)
4788 {
4789 tmp2 = gst_caps_copy(tmp);
4790 gst_caps_set_features_simple(tmp2, gst_caps_features_from_string(GST_CAPS_FEATURE_MEMORY_DMABUF));
4791 gst_caps_append(ret, tmp);
4792 gst_caps_append(ret, tmp2);
4793 }
4794
4795 gst_structure_free(template);
4796 }
4797
4798 if (filter)
4799 {
4800 GstCaps *tmp;
4801
4802 tmp = ret;
4803 ret = gst_caps_intersect_full(filter, ret, GST_CAPS_INTERSECT_FIRST);
4804 gst_caps_unref(tmp);
4805 }
4806
4807 GST_INFO_OBJECT(v4l2object->dbg_obj, "probed caps: %" GST_PTR_FORMAT, ret);
4808
4809 return ret;
4810}
4811
4812GstCaps *
4813gst_aml_v4l2_object_get_caps(GstAmlV4l2Object *v4l2object, GstCaps *filter)
4814{
4815 GstCaps *ret;
4816
4817 if (v4l2object->probed_caps == NULL)
4818 v4l2object->probed_caps = gst_aml_v4l2_object_probe_caps(v4l2object, NULL);
4819
4820 if (filter)
4821 {
4822 ret = gst_caps_intersect_full(filter, v4l2object->probed_caps,
4823 GST_CAPS_INTERSECT_FIRST);
4824 }
4825 else
4826 {
4827 ret = gst_caps_ref(v4l2object->probed_caps);
4828 }
4829
4830 return ret;
4831}
4832
4833gboolean
4834gst_aml_v4l2_object_decide_allocation(GstAmlV4l2Object *obj, GstQuery *query)
4835{
4836 GstCaps *caps;
4837 GstBufferPool *pool = NULL, *other_pool = NULL;
4838 GstStructure *config;
4839 guint size, min, max, own_min = 0;
4840 gboolean update;
4841 gboolean has_video_meta;
4842 gboolean can_share_own_pool, pushing_from_our_pool = FALSE;
4843 GstAllocator *allocator = NULL;
4844 GstAllocationParams params = {0};
4845
4846 GST_DEBUG_OBJECT(obj->dbg_obj, "decide allocation");
4847
4848 g_return_val_if_fail(obj->type == V4L2_BUF_TYPE_VIDEO_CAPTURE ||
4849 obj->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE,
4850 FALSE);
4851
4852 gst_query_parse_allocation(query, &caps, NULL);
4853
4854 if (obj->pool == NULL)
4855 {
4856 if (!gst_aml_v4l2_object_setup_pool(obj, caps))
4857 goto pool_failed;
4858 }
4859
4860 if (gst_query_get_n_allocation_params(query) > 0)
4861 gst_query_parse_nth_allocation_param(query, 0, &allocator, &params);
4862
4863 if (gst_query_get_n_allocation_pools(query) > 0)
4864 {
4865 gst_query_parse_nth_allocation_pool(query, 0, &pool, &size, &min, &max);
4866 update = TRUE;
4867 }
4868 else
4869 {
4870 pool = NULL;
4871 min = max = 0;
4872 size = 0;
4873 update = FALSE;
4874 }
4875
4876 GST_DEBUG_OBJECT(obj->dbg_obj, "allocation: size:%u min:%u max:%u pool:%" GST_PTR_FORMAT, size, min, max, pool);
4877
4878 has_video_meta =
4879 gst_query_find_allocation_meta(query, GST_VIDEO_META_API_TYPE, NULL);
4880
4881 can_share_own_pool = (has_video_meta || !obj->need_video_meta);
4882
4883 gst_aml_v4l2_get_driver_min_buffers(obj);
4884 /* We can't share our own pool, if it exceed V4L2 capacity */
4885 if (min + obj->min_buffers + 1 > VIDEO_MAX_FRAME)
4886 can_share_own_pool = FALSE;
4887
4888 /* select a pool */
4889 switch (obj->mode)
4890 {
4891 case GST_V4L2_IO_RW:
4892 if (pool)
4893 {
4894 /* in READ/WRITE mode, prefer a downstream pool because our own pool
4895 * doesn't help much, we have to write to it as well */
4896 GST_DEBUG_OBJECT(obj->dbg_obj,
4897 "read/write mode: using downstream pool");
4898 /* use the bigest size, when we use our own pool we can't really do any
4899 * other size than what the hardware gives us but for downstream pools
4900 * we can try */
4901 size = MAX(size, obj->info.size);
4902 }
4903 else if (can_share_own_pool)
4904 {
4905 /* no downstream pool, use our own then */
4906 GST_DEBUG_OBJECT(obj->dbg_obj,
4907 "read/write mode: no downstream pool, using our own");
4908 pool = gst_object_ref(obj->pool);
4909 size = obj->info.size;
4910 pushing_from_our_pool = TRUE;
4911 }
4912 break;
4913
4914 case GST_V4L2_IO_USERPTR:
4915 case GST_V4L2_IO_DMABUF_IMPORT:
4916 /* in importing mode, prefer our own pool, and pass the other pool to
4917 * our own, so it can serve itself */
4918 if (pool == NULL)
4919 goto no_downstream_pool;
4920 gst_aml_v4l2_buffer_pool_set_other_pool(GST_AML_V4L2_BUFFER_POOL(obj->pool),
4921 pool);
4922 other_pool = pool;
4923 gst_object_unref(pool);
4924 pool = gst_object_ref(obj->pool);
4925 size = obj->info.size;
4926 break;
4927
4928 case GST_V4L2_IO_MMAP:
4929 case GST_V4L2_IO_DMABUF:
4930 /* in streaming mode, prefer our own pool */
4931 /* Check if we can use it ... */
4932 if (can_share_own_pool)
4933 {
4934 if (pool)
4935 gst_object_unref(pool);
4936 pool = gst_object_ref(obj->pool);
4937 size = obj->info.size;
4938 GST_DEBUG_OBJECT(obj->dbg_obj,
4939 "streaming mode: using our own pool %" GST_PTR_FORMAT, pool);
4940 pushing_from_our_pool = TRUE;
4941 }
4942 else if (pool)
4943 {
4944 GST_DEBUG_OBJECT(obj->dbg_obj,
4945 "streaming mode: copying to downstream pool %" GST_PTR_FORMAT,
4946 pool);
4947 }
4948 else
4949 {
4950 GST_DEBUG_OBJECT(obj->dbg_obj,
4951 "streaming mode: no usable pool, copying to generic pool");
4952 size = MAX(size, obj->info.size);
4953 }
4954 break;
4955 case GST_V4L2_IO_AUTO:
4956 default:
4957 GST_WARNING_OBJECT(obj->dbg_obj, "unhandled mode");
4958 break;
4959 }
4960
4961 if (size == 0)
4962 goto no_size;
4963
4964 /* If pushing from our own pool, configure it with queried minimum,
4965 * otherwise use the minimum required */
4966 if (pushing_from_our_pool)
4967 {
4968 /* When pushing from our own pool, we need what downstream one, to be able
4969 * to fill the pipeline, the minimum required to decoder according to the
4970 * driver and 2 more, so we don't endup up with everything downstream or
4971 * held by the decoder. We account 2 buffers for v4l2 so when one is being
4972 * pushed downstream the other one can already be queued for the next
4973 * frame. */
4974 own_min = min + obj->min_buffers + 2;
4975
4976 /* If no allocation parameters where provided, allow for a little more
4977 * buffers and enable copy threshold */
4978 if (!update)
4979 {
4980 own_min += 2;
4981 gst_aml_v4l2_buffer_pool_copy_at_threshold(GST_AML_V4L2_BUFFER_POOL(pool),
4982 TRUE);
4983 }
4984 else
4985 {
4986 gst_aml_v4l2_buffer_pool_copy_at_threshold(GST_AML_V4L2_BUFFER_POOL(pool),
4987 FALSE);
4988 }
4989 }
4990 else
4991 {
4992 /* In this case we'll have to configure two buffer pool. For our buffer
4993 * pool, we'll need what the driver one, and one more, so we can dequeu */
4994 own_min = obj->min_buffers + 1;
4995 own_min = MAX(own_min, GST_AML_V4L2_MIN_BUFFERS);
4996
4997 /* for the downstream pool, we keep what downstream wants, though ensure
4998 * at least a minimum if downstream didn't suggest anything (we are
4999 * expecting the base class to create a default one for the context) */
5000 min = MAX(min, GST_AML_V4L2_MIN_BUFFERS);
5001
5002 /* To import we need the other pool to hold at least own_min */
5003 if (obj->pool == pool)
5004 min += own_min;
5005 }
5006
5007 /* Request a bigger max, if one was suggested but it's too small */
5008 if (max != 0)
5009 max = MAX(min, max);
5010
5011 /* First step, configure our own pool */
5012 config = gst_buffer_pool_get_config(obj->pool);
5013
5014 if (obj->need_video_meta || has_video_meta)
5015 {
5016 GST_DEBUG_OBJECT(obj->dbg_obj, "activate Video Meta");
5017 gst_buffer_pool_config_add_option(config,
5018 GST_BUFFER_POOL_OPTION_VIDEO_META);
5019 }
5020
5021 gst_buffer_pool_config_set_allocator(config, allocator, &params);
5022 gst_buffer_pool_config_set_params(config, caps, size, own_min + DEFAULT_EXTRA_CAPTURE_BUF_SIZE, own_min + DEFAULT_EXTRA_CAPTURE_BUF_SIZE);
5023
5024 GST_DEBUG_OBJECT(obj->dbg_obj, "setting own pool config to %" GST_PTR_FORMAT, config);
5025
5026 /* Our pool often need to adjust the value */
5027 if (!gst_buffer_pool_set_config(obj->pool, config))
5028 {
5029 config = gst_buffer_pool_get_config(obj->pool);
5030
5031 GST_DEBUG_OBJECT(obj->dbg_obj, "own pool config changed to %" GST_PTR_FORMAT, config);
5032
5033 /* our pool will adjust the maximum buffer, which we are fine with */
5034 if (!gst_buffer_pool_set_config(obj->pool, config))
5035 goto config_failed;
5036 }
5037
5038 /* Now configure the other pool if different */
5039 if (obj->pool != pool)
5040 other_pool = pool;
5041
5042 if (other_pool)
5043 {
5044 GstAmlV4l2VideoDec *self = (GstAmlV4l2VideoDec *)obj->element;
5045 if (self->is_secure_path)
5046 {
5047 params.flags |= GST_MEMORY_FLAG_LAST << 1; // in drmallocator GST_MEMORY_FLAG_LAST << 1 represent GST_MEMORY_FLAG_SECURE
5048 GST_DEBUG_OBJECT(obj, "set secure flag for drmbufferpool flag:0x%x", params.flags);
5049 }
5050 config = gst_buffer_pool_get_config(other_pool);
5051 gst_buffer_pool_config_set_allocator(config, allocator, &params);
5052 gst_buffer_pool_config_set_params(config, caps, size, own_min + DEFAULT_EXTRA_CAPTURE_BUF_SIZE, own_min + DEFAULT_EXTRA_CAPTURE_BUF_SIZE);
5053 gst_buffer_pool_config_set_video_alignment(config, &obj->align);
5054
5055 GST_DEBUG_OBJECT(obj->dbg_obj, "setting other pool config to %" GST_PTR_FORMAT, config);
5056
5057 /* if downstream supports video metadata, add this to the pool config */
5058 if (has_video_meta)
5059 {
5060 GST_DEBUG_OBJECT(obj->dbg_obj, "activate Video Meta");
5061 gst_buffer_pool_config_add_option(config,
5062 GST_BUFFER_POOL_OPTION_VIDEO_META);
5063 }
5064
5065 if (!gst_buffer_pool_set_config(other_pool, config))
5066 {
5067 config = gst_buffer_pool_get_config(other_pool);
5068
5069 if (!gst_buffer_pool_config_validate_params(config, caps, size, min,
5070 max))
5071 {
5072 gst_structure_free(config);
5073 goto config_failed;
5074 }
5075
5076 if (!gst_buffer_pool_set_config(other_pool, config))
5077 goto config_failed;
5078 }
5079 }
5080
5081 if (pool)
5082 {
5083 /* For simplicity, simply read back the active configuration, so our base
5084 * class get the right information */
5085 config = gst_buffer_pool_get_config(pool);
5086 gst_buffer_pool_config_get_params(config, NULL, &size, &min, &max);
5087 gst_structure_free(config);
5088 }
5089
5090 if (update)
5091 gst_query_set_nth_allocation_pool(query, 0, pool, size, min, max);
5092 else
5093 gst_query_add_allocation_pool(query, pool, size, min, max);
5094
5095 if (allocator)
5096 gst_object_unref(allocator);
5097
5098 if (pool)
5099 gst_object_unref(pool);
5100
5101 return TRUE;
5102
5103pool_failed:
5104{
5105 /* setup_pool already send the error */
5106 goto cleanup;
5107}
5108config_failed:
5109{
5110 GST_ELEMENT_ERROR(obj->element, RESOURCE, SETTINGS,
5111 (_("Failed to configure internal buffer pool.")), (NULL));
5112 goto cleanup;
5113}
5114no_size:
5115{
5116 GST_ELEMENT_ERROR(obj->element, RESOURCE, SETTINGS,
5117 (_("Video device did not suggest any buffer size.")), (NULL));
5118 goto cleanup;
5119}
5120cleanup:
5121{
5122 if (allocator)
5123 gst_object_unref(allocator);
5124
5125 if (pool)
5126 gst_object_unref(pool);
5127 return FALSE;
5128}
5129no_downstream_pool:
5130{
5131 GST_ELEMENT_ERROR(obj->element, RESOURCE, SETTINGS,
5132 (_("No downstream pool to import from.")),
5133 ("When importing DMABUF or USERPTR, we need a pool to import from"));
5134 return FALSE;
5135}
5136}
5137
5138gboolean
5139gst_aml_v4l2_object_propose_allocation(GstAmlV4l2Object *obj, GstQuery *query)
5140{
5141 GstBufferPool *pool;
5142 /* we need at least 2 buffers to operate */
5143 guint size, min, max;
5144 GstCaps *caps;
5145 gboolean need_pool;
5146
5147 /* Set defaults allocation parameters */
5148 size = obj->info.size;
5149 min = GST_AML_V4L2_MIN_BUFFERS;
5150 max = VIDEO_MAX_FRAME;
5151
5152 gst_query_parse_allocation(query, &caps, &need_pool);
5153
5154 if (caps == NULL)
5155 goto no_caps;
5156
5157 switch (obj->mode)
5158 {
5159 case GST_V4L2_IO_MMAP:
5160 case GST_V4L2_IO_DMABUF:
5161 if ((pool = obj->pool))
5162 gst_object_ref(pool);
5163 break;
5164 default:
5165 pool = NULL;
5166 break;
5167 }
5168
5169 if (pool != NULL)
5170 {
5171 GstCaps *pcaps;
5172 GstStructure *config;
5173
5174 /* we had a pool, check caps */
5175 config = gst_buffer_pool_get_config(pool);
5176 gst_buffer_pool_config_get_params(config, &pcaps, NULL, NULL, NULL);
5177
5178 GST_DEBUG_OBJECT(obj->dbg_obj,
5179 "we had a pool with caps %" GST_PTR_FORMAT, pcaps);
5180 if (!gst_caps_is_equal(caps, pcaps))
5181 {
5182 gst_structure_free(config);
5183 gst_object_unref(pool);
5184 goto different_caps;
5185 }
5186 gst_structure_free(config);
5187 }
5188 gst_aml_v4l2_get_driver_min_buffers(obj);
5189
5190 min = MAX(obj->min_buffers, GST_AML_V4L2_MIN_BUFFERS);
5191
5192 gst_query_add_allocation_pool(query, pool, size, min, max);
5193
5194 /* we also support various metadata */
5195 gst_query_add_allocation_meta(query, GST_VIDEO_META_API_TYPE, NULL);
5196
5197 if (pool)
5198 gst_object_unref(pool);
5199
5200 return TRUE;
5201
5202 /* ERRORS */
5203no_caps:
5204{
5205 GST_DEBUG_OBJECT(obj->dbg_obj, "no caps specified");
5206 return FALSE;
5207}
5208different_caps:
5209{
5210 /* different caps, we can't use this pool */
5211 GST_DEBUG_OBJECT(obj->dbg_obj, "pool has different caps");
5212 return FALSE;
5213}
5214}
5215
5216gboolean
5217gst_aml_v4l2_object_try_import(GstAmlV4l2Object *obj, GstBuffer *buffer)
5218{
5219 GstVideoMeta *vmeta;
5220 guint n_mem = gst_buffer_n_memory(buffer);
5221
5222 /* only import if requested */
5223 switch (obj->mode)
5224 {
5225 case GST_V4L2_IO_USERPTR:
5226 case GST_V4L2_IO_DMABUF_IMPORT:
5227 break;
5228 default:
5229 GST_DEBUG_OBJECT(obj->dbg_obj,
5230 "The io-mode does not enable importation");
5231 return FALSE;
5232 }
5233
5234 vmeta = gst_buffer_get_video_meta(buffer);
5235 if (!vmeta && obj->need_video_meta)
5236 {
5237 GST_DEBUG_OBJECT(obj->dbg_obj, "Downstream buffer uses standard "
5238 "stride/offset while the driver does not.");
5239 return FALSE;
5240 }
5241
5242 /* we need matching strides/offsets and size */
5243 if (vmeta)
5244 {
5245 guint p;
5246 gboolean need_fmt_update = FALSE;
5247
5248 if (vmeta->n_planes != GST_VIDEO_INFO_N_PLANES(&obj->info))
5249 {
5250 GST_WARNING_OBJECT(obj->dbg_obj,
5251 "Cannot import buffers with different number planes");
5252 return FALSE;
5253 }
5254
5255 for (p = 0; p < vmeta->n_planes; p++)
5256 {
5257 if (vmeta->stride[p] < obj->info.stride[p])
5258 {
5259 GST_DEBUG_OBJECT(obj->dbg_obj,
5260 "Not importing as remote stride %i is smaller then %i on plane %u",
5261 vmeta->stride[p], obj->info.stride[p], p);
5262 return FALSE;
5263 }
5264 else if (vmeta->stride[p] > obj->info.stride[p])
5265 {
5266 need_fmt_update = TRUE;
5267 }
5268
5269 if (vmeta->offset[p] < obj->info.offset[p])
5270 {
5271 GST_DEBUG_OBJECT(obj->dbg_obj,
5272 "Not importing as offset %" G_GSIZE_FORMAT
5273 " is smaller then %" G_GSIZE_FORMAT " on plane %u",
5274 vmeta->offset[p], obj->info.offset[p], p);
5275 return FALSE;
5276 }
5277 else if (vmeta->offset[p] > obj->info.offset[p])
5278 {
5279 need_fmt_update = TRUE;
5280 }
5281 }
5282
5283 if (need_fmt_update)
5284 {
5285 struct v4l2_format format;
5286 gint wanted_stride[GST_VIDEO_MAX_PLANES] = {
5287 0,
5288 };
5289
5290 format = obj->format;
5291
5292 /* update the current format with the stride we want to import from */
5293 if (V4L2_TYPE_IS_MULTIPLANAR(obj->type))
5294 {
5295 guint i;
5296
5297 GST_DEBUG_OBJECT(obj->dbg_obj, "Wanted strides:");
5298
5299 for (i = 0; i < obj->n_v4l2_planes; i++)
5300 {
5301 gint stride = vmeta->stride[i];
5302
5303 if (GST_VIDEO_FORMAT_INFO_IS_TILED(obj->info.finfo))
5304 stride = GST_VIDEO_TILE_X_TILES(stride) << GST_VIDEO_FORMAT_INFO_TILE_WS(obj->info.finfo);
5305
5306 format.fmt.pix_mp.plane_fmt[i].bytesperline = stride;
5307 wanted_stride[i] = stride;
5308 GST_DEBUG_OBJECT(obj->dbg_obj, " [%u] %i", i, wanted_stride[i]);
5309 }
5310 }
5311 else
5312 {
5313 gint stride = vmeta->stride[0];
5314
5315 GST_DEBUG_OBJECT(obj->dbg_obj, "Wanted stride: %i", stride);
5316
5317 if (GST_VIDEO_FORMAT_INFO_IS_TILED(obj->info.finfo))
5318 stride = GST_VIDEO_TILE_X_TILES(stride) << GST_VIDEO_FORMAT_INFO_TILE_WS(obj->info.finfo);
5319
5320 format.fmt.pix.bytesperline = stride;
5321 wanted_stride[0] = stride;
5322 }
5323
5324 if (obj->ioctl(obj->video_fd, VIDIOC_S_FMT, &format) < 0)
5325 {
5326 GST_WARNING_OBJECT(obj->dbg_obj,
5327 "Something went wrong trying to update current format: %s",
5328 g_strerror(errno));
5329 return FALSE;
5330 }
5331
5332 gst_aml_v4l2_object_save_format(obj, obj->fmtdesc, &format, &obj->info,
5333 &obj->align);
5334
5335 if (V4L2_TYPE_IS_MULTIPLANAR(obj->type))
5336 {
5337 guint i;
5338
5339 for (i = 0; i < obj->n_v4l2_planes; i++)
5340 {
5341 if (format.fmt.pix_mp.plane_fmt[i].bytesperline != wanted_stride[i])
5342 {
5343 GST_DEBUG_OBJECT(obj->dbg_obj,
5344 "[%i] Driver did not accept the new stride (wants %i, got %i)",
5345 i, format.fmt.pix_mp.plane_fmt[i].bytesperline,
5346 wanted_stride[i]);
5347 return FALSE;
5348 }
5349 }
5350 }
5351 else
5352 {
5353 if (format.fmt.pix.bytesperline != wanted_stride[0])
5354 {
5355 GST_DEBUG_OBJECT(obj->dbg_obj,
5356 "Driver did not accept the new stride (wants %i, got %i)",
5357 format.fmt.pix.bytesperline, wanted_stride[0]);
5358 return FALSE;
5359 }
5360 }
5361 }
5362 }
5363
5364 /* we can always import single memory buffer, but otherwise we need the same
5365 * amount of memory object. */
5366 if (n_mem != 1 && n_mem != obj->n_v4l2_planes)
5367 {
5368 GST_DEBUG_OBJECT(obj->dbg_obj, "Can only import %i memory, "
5369 "buffers contains %u memory",
5370 obj->n_v4l2_planes, n_mem);
5371 return FALSE;
5372 }
5373
5374 /* For DMABuf importation we need DMABuf of course */
5375 if (obj->mode == GST_V4L2_IO_DMABUF_IMPORT)
5376 {
5377 guint i;
5378
5379 for (i = 0; i < n_mem; i++)
5380 {
5381 GstMemory *mem = gst_buffer_peek_memory(buffer, i);
5382
5383 if (!gst_is_dmabuf_memory(mem))
5384 {
5385 GST_DEBUG_OBJECT(obj->dbg_obj, "Cannot import non-DMABuf memory.");
5386 return FALSE;
5387 }
5388 }
5389 }
5390
5391 /* for the remaining, only the kernel driver can tell */
5392 return TRUE;
5393}
5394
5395gboolean gst_aml_v4l2_set_drm_mode(GstAmlV4l2Object *v4l2object)
5396{
5397 /* On AmLogic, output obj use of GST_V4L2_IO_DMABUF_IMPORT implies secure memory */
5398 if (v4l2object->req_mode == GST_V4L2_IO_DMABUF_IMPORT)
5399 {
5400 int rc;
5401 struct v4l2_queryctrl queryctrl;
5402 struct v4l2_control control;
5403
5404 GstAmlV4l2VideoDec *self = (GstAmlV4l2VideoDec *)v4l2object->element;
5405 self->is_secure_path = TRUE;
5406
5407#define V4L2_CID_USER_AMLOGIC_BASE (V4L2_CID_USER_BASE + 0x1100)
5408#define AML_V4L2_SET_DRMMODE (V4L2_CID_USER_AMLOGIC_BASE + 0)
5409 memset(&queryctrl, 0, sizeof(queryctrl));
5410 queryctrl.id = AML_V4L2_SET_DRMMODE;
5411
5412 rc = v4l2object->ioctl(v4l2object->video_fd, VIDIOC_QUERYCTRL, &queryctrl);
5413 if (rc == 0)
5414 {
5415 if (!(queryctrl.flags & V4L2_CTRL_FLAG_DISABLED))
5416 {
5417 memset(&control, 0, sizeof(control));
5418 control.id = AML_V4L2_SET_DRMMODE;
5419 control.value = 1;
5420 rc = v4l2object->ioctl(v4l2object->video_fd, VIDIOC_S_CTRL, &control);
5421 if (rc != 0)
5422 {
5423 GST_ERROR_OBJECT(v4l2object, "AML_V4L2_SET_DRMMODE fail: rc %d", rc);
5424 return FALSE;
5425 }
5426 GST_DEBUG_OBJECT(v4l2object, "AML_V4L2_SET_DRMMODE set succ");
5427 return TRUE;
5428 }
5429 else
5430 {
5431 GST_DEBUG_OBJECT(v4l2object, "AML_V4L2_SET_DRMMODE is disabled");
5432 return TRUE;
5433 }
5434 }
5435 else
5436 {
5437 GST_ERROR_OBJECT(v4l2object, "VIDIOC_QUERYCTRL for AML_V4L2_SET_DRMMODE fail");
5438 return FALSE;
5439 }
5440 }
5441 else
5442 {
5443 GST_DEBUG_OBJECT(v4l2object, "req mode is not GST_V4L2_IO_DMABUF_IMPORT, DRM mode does not need to be configured");
5444 return TRUE;
5445 }
5446}