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