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