blob: 78f3e0f24798d10a9491b1081f4a49132eddf270 [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 }
bo.xiao8eab6d52024-07-16 19:56:07 +08001885 else if (g_str_equal(mimetype, "video/mjpeg"))
xuesong.jiangae1548e2022-05-06 16:38:46 +08001886 {
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 }
bo.xiao8eab6d52024-07-16 19:56:07 +08001983 else
1984 {
1985 GST_ERROR("Unknown video codec %s.", mimetype);
1986 }
xuesong.jiangae1548e2022-05-06 16:38:46 +08001987 }
1988
1989 /* Prefer the non-contiguous if supported */
1990 v4l2object->prefered_non_contiguous = TRUE;
1991
1992 if (fourcc_nc)
1993 fmt = gst_aml_v4l2_object_get_format_from_fourcc(v4l2object, fourcc_nc);
1994 else if (fourcc == 0)
1995 goto unhandled_format;
1996
1997 if (fmt == NULL)
1998 {
1999 fmt = gst_aml_v4l2_object_get_format_from_fourcc(v4l2object, fourcc);
2000 v4l2object->prefered_non_contiguous = FALSE;
2001 }
2002
2003 if (fmt == NULL)
2004 goto unsupported_format;
2005
2006 *format = fmt;
2007
2008 return TRUE;
2009
2010 /* ERRORS */
2011invalid_format:
2012{
2013 GST_DEBUG_OBJECT(v4l2object, "invalid format");
2014 return FALSE;
2015}
2016unhandled_format:
2017{
2018 GST_DEBUG_OBJECT(v4l2object, "unhandled format");
2019 return FALSE;
2020}
2021unsupported_format:
2022{
2023 GST_DEBUG_OBJECT(v4l2object, "unsupported format");
2024 return FALSE;
2025}
2026}
2027
2028static gboolean
2029gst_aml_v4l2_object_get_nearest_size(GstAmlV4l2Object *v4l2object,
2030 guint32 pixelformat, gint *width, gint *height);
2031
2032static void
2033gst_aml_v4l2_object_add_aspect_ratio(GstAmlV4l2Object *v4l2object, GstStructure *s)
2034{
2035 if (v4l2object->keep_aspect && v4l2object->par)
2036 gst_structure_set_value(s, "pixel-aspect-ratio", v4l2object->par);
2037}
2038
2039/* returns TRUE if the value was changed in place, otherwise FALSE */
2040static gboolean
2041gst_aml_v4l2src_value_simplify(GValue *val)
2042{
2043 /* simplify list of one value to one value */
2044 if (GST_VALUE_HOLDS_LIST(val) && gst_value_list_get_size(val) == 1)
2045 {
2046 const GValue *list_val;
2047 GValue new_val = G_VALUE_INIT;
2048
2049 list_val = gst_value_list_get_value(val, 0);
2050 g_value_init(&new_val, G_VALUE_TYPE(list_val));
2051 g_value_copy(list_val, &new_val);
2052 g_value_unset(val);
2053 *val = new_val;
2054 return TRUE;
2055 }
2056
2057 return FALSE;
2058}
2059
2060static gboolean
2061gst_aml_v4l2_object_get_interlace_mode(enum v4l2_field field,
2062 GstVideoInterlaceMode *interlace_mode)
2063{
2064 switch (field)
2065 {
2066 case V4L2_FIELD_ANY:
2067 GST_ERROR("Driver bug detected - check driver with v4l2-compliance from http://git.linuxtv.org/v4l-utils.git\n");
2068 /* fallthrough */
2069 case V4L2_FIELD_NONE:
2070 *interlace_mode = GST_VIDEO_INTERLACE_MODE_PROGRESSIVE;
2071 return TRUE;
2072 case V4L2_FIELD_INTERLACED:
2073 case V4L2_FIELD_INTERLACED_TB:
2074 case V4L2_FIELD_INTERLACED_BT:
2075 *interlace_mode = GST_VIDEO_INTERLACE_MODE_INTERLEAVED;
2076 return TRUE;
2077 default:
2078 GST_ERROR("Unknown enum v4l2_field %d", field);
2079 return FALSE;
2080 }
2081}
2082
2083static gboolean
2084gst_aml_v4l2_object_get_colorspace(struct v4l2_format *fmt,
2085 GstVideoColorimetry *cinfo)
2086{
2087 gboolean is_rgb =
2088 gst_amL_v4l2_object_v4l2fourcc_is_rgb(fmt->fmt.pix.pixelformat);
2089 enum v4l2_colorspace colorspace;
2090 enum v4l2_quantization range;
2091 enum v4l2_ycbcr_encoding matrix;
2092 enum v4l2_xfer_func transfer;
2093 gboolean ret = TRUE;
2094
2095 if (V4L2_TYPE_IS_MULTIPLANAR(fmt->type))
2096 {
2097 colorspace = fmt->fmt.pix_mp.colorspace;
2098 range = fmt->fmt.pix_mp.quantization;
2099 matrix = fmt->fmt.pix_mp.ycbcr_enc;
2100 transfer = fmt->fmt.pix_mp.xfer_func;
2101 }
2102 else
2103 {
2104 colorspace = fmt->fmt.pix.colorspace;
2105 range = fmt->fmt.pix.quantization;
2106 matrix = fmt->fmt.pix.ycbcr_enc;
2107 transfer = fmt->fmt.pix.xfer_func;
2108 }
xuesong.jiange1a19662022-06-21 20:30:22 +08002109 GST_DEBUG("colorspace:%d, range:%d, matrix:%d, transfer:%d", colorspace, range, matrix, transfer);
2110 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 +08002111
2112 /* First step, set the defaults for each primaries */
2113 switch (colorspace)
2114 {
2115 case V4L2_COLORSPACE_SMPTE170M:
2116 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2117 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
2118 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
2119 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_SMPTE170M;
2120 break;
2121 case V4L2_COLORSPACE_REC709:
2122 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2123 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT709;
2124 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
2125 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT709;
2126 break;
2127 case V4L2_COLORSPACE_SRGB:
2128 case V4L2_COLORSPACE_JPEG:
2129 cinfo->range = GST_VIDEO_COLOR_RANGE_0_255;
2130 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
2131 cinfo->transfer = GST_VIDEO_TRANSFER_SRGB;
2132 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT709;
2133 break;
2134 case V4L2_COLORSPACE_OPRGB:
2135 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2136 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
2137 cinfo->transfer = GST_VIDEO_TRANSFER_ADOBERGB;
2138 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_ADOBERGB;
2139 break;
2140 case V4L2_COLORSPACE_BT2020:
2141 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2142 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT2020;
2143 cinfo->transfer = GST_VIDEO_TRANSFER_BT2020_12;
2144 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT2020;
2145 break;
2146 case V4L2_COLORSPACE_SMPTE240M:
2147 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2148 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_SMPTE240M;
2149 cinfo->transfer = GST_VIDEO_TRANSFER_SMPTE240M;
2150 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_SMPTE240M;
2151 break;
2152 case V4L2_COLORSPACE_470_SYSTEM_M:
2153 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2154 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
2155 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
2156 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT470M;
2157 break;
2158 case V4L2_COLORSPACE_470_SYSTEM_BG:
2159 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2160 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
2161 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
2162 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_BT470BG;
2163 break;
2164 case V4L2_COLORSPACE_RAW:
2165 /* Explicitly unknown */
2166 cinfo->range = GST_VIDEO_COLOR_RANGE_UNKNOWN;
2167 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_UNKNOWN;
2168 cinfo->transfer = GST_VIDEO_TRANSFER_UNKNOWN;
2169 cinfo->primaries = GST_VIDEO_COLOR_PRIMARIES_UNKNOWN;
2170 break;
2171 default:
2172 GST_DEBUG("Unknown enum v4l2_colorspace %d", colorspace);
2173 ret = FALSE;
2174 break;
2175 }
xuesong.jiange1a19662022-06-21 20:30:22 +08002176 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 +08002177
2178 if (!ret)
2179 goto done;
2180
2181 /* Second step, apply any custom variation */
2182 switch (range)
2183 {
2184 case V4L2_QUANTIZATION_FULL_RANGE:
2185 cinfo->range = GST_VIDEO_COLOR_RANGE_0_255;
2186 break;
2187 case V4L2_QUANTIZATION_LIM_RANGE:
2188 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2189 break;
2190 case V4L2_QUANTIZATION_DEFAULT:
2191 /* replicated V4L2_MAP_QUANTIZATION_DEFAULT macro behavior */
2192 if (is_rgb && colorspace == V4L2_COLORSPACE_BT2020)
2193 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2194 else if (is_rgb || matrix == V4L2_YCBCR_ENC_XV601 || matrix == V4L2_YCBCR_ENC_XV709 || colorspace == V4L2_COLORSPACE_JPEG)
2195 cinfo->range = GST_VIDEO_COLOR_RANGE_0_255;
2196 else
2197 cinfo->range = GST_VIDEO_COLOR_RANGE_16_235;
2198 break;
2199 default:
2200 GST_WARNING("Unknown enum v4l2_quantization value %d", range);
2201 cinfo->range = GST_VIDEO_COLOR_RANGE_UNKNOWN;
2202 break;
2203 }
xuesong.jiange1a19662022-06-21 20:30:22 +08002204 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 +08002205
2206 switch (matrix)
2207 {
2208 case V4L2_YCBCR_ENC_XV601:
2209 case V4L2_YCBCR_ENC_SYCC:
2210 GST_FIXME("XV601 and SYCC not defined, assuming 601");
2211 /* fallthrough */
2212 case V4L2_YCBCR_ENC_601:
2213 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT601;
2214 break;
2215 case V4L2_YCBCR_ENC_XV709:
2216 GST_FIXME("XV709 not defined, assuming 709");
2217 /* fallthrough */
2218 case V4L2_YCBCR_ENC_709:
2219 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT709;
2220 break;
2221 case V4L2_YCBCR_ENC_BT2020_CONST_LUM:
2222 GST_FIXME("BT2020 with constant luma is not defined, assuming BT2020");
2223 /* fallthrough */
2224 case V4L2_YCBCR_ENC_BT2020:
2225 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_BT2020;
2226 break;
2227 case V4L2_YCBCR_ENC_SMPTE240M:
2228 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_SMPTE240M;
2229 break;
2230 case V4L2_YCBCR_ENC_DEFAULT:
2231 /* nothing, just use defaults for colorspace */
2232 break;
2233 default:
2234 GST_WARNING("Unknown enum v4l2_ycbcr_encoding value %d", matrix);
2235 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_UNKNOWN;
2236 break;
2237 }
xuesong.jiange1a19662022-06-21 20:30:22 +08002238 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 +08002239
2240 /* Set identity matrix for R'G'B' formats to avoid creating
2241 * confusion. This though is cosmetic as it's now properly ignored by
2242 * the video info API and videoconvert. */
2243 if (is_rgb)
2244 cinfo->matrix = GST_VIDEO_COLOR_MATRIX_RGB;
2245
2246 switch (transfer)
2247 {
2248 case V4L2_XFER_FUNC_709:
2249 if (colorspace == V4L2_COLORSPACE_BT2020 && fmt->fmt.pix.height >= 2160)
2250 cinfo->transfer = GST_VIDEO_TRANSFER_BT2020_12;
2251 else
2252 cinfo->transfer = GST_VIDEO_TRANSFER_BT709;
2253 break;
2254 case V4L2_XFER_FUNC_SRGB:
2255 cinfo->transfer = GST_VIDEO_TRANSFER_SRGB;
2256 break;
2257 case V4L2_XFER_FUNC_OPRGB:
2258 cinfo->transfer = GST_VIDEO_TRANSFER_ADOBERGB;
2259 break;
2260 case V4L2_XFER_FUNC_SMPTE240M:
2261 cinfo->transfer = GST_VIDEO_TRANSFER_SMPTE240M;
2262 break;
2263 case V4L2_XFER_FUNC_NONE:
2264 cinfo->transfer = GST_VIDEO_TRANSFER_GAMMA10;
2265 break;
2266 case V4L2_XFER_FUNC_DEFAULT:
2267 /* nothing, just use defaults for colorspace */
2268 break;
2269 default:
2270 GST_WARNING("Unknown enum v4l2_xfer_func value %d", transfer);
2271 cinfo->transfer = GST_VIDEO_TRANSFER_UNKNOWN;
2272 break;
2273 }
xuesong.jiange1a19662022-06-21 20:30:22 +08002274 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 +08002275
2276done:
2277 return ret;
2278}
2279
2280static int
2281gst_aml_v4l2_object_try_fmt(GstAmlV4l2Object *v4l2object,
2282 struct v4l2_format *try_fmt)
2283{
2284 int fd = v4l2object->video_fd;
2285 struct v4l2_format fmt;
2286 int r;
2287
2288 memcpy(&fmt, try_fmt, sizeof(fmt));
2289 r = v4l2object->ioctl(fd, VIDIOC_TRY_FMT, &fmt);
2290
2291 if (r < 0 && errno == ENOTTY)
2292 {
2293 /* The driver might not implement TRY_FMT, in which case we will try
2294 S_FMT to probe */
2295 if (GST_AML_V4L2_IS_ACTIVE(v4l2object))
2296 goto error;
2297
2298 memcpy(&fmt, try_fmt, sizeof(fmt));
2299 r = v4l2object->ioctl(fd, VIDIOC_S_FMT, &fmt);
2300 }
2301 memcpy(try_fmt, &fmt, sizeof(fmt));
2302
2303 return r;
2304
2305error:
2306 memcpy(try_fmt, &fmt, sizeof(fmt));
2307 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2308 "Unable to try format: %s", g_strerror(errno));
2309 return r;
2310}
2311
2312static void
2313gst_aml_v4l2_object_add_interlace_mode(GstAmlV4l2Object *v4l2object,
2314 GstStructure *s, guint32 width, guint32 height, guint32 pixelformat)
2315{
2316 struct v4l2_format fmt;
2317 GValue interlace_formats = {
2318 0,
2319 };
2320 enum v4l2_field formats[] = {V4L2_FIELD_NONE, V4L2_FIELD_INTERLACED};
2321 gsize i;
2322 GstVideoInterlaceMode interlace_mode, prev = -1;
2323
2324 if (!g_str_equal(gst_structure_get_name(s), "video/x-raw"))
2325 return;
2326
2327 if (v4l2object->never_interlaced)
2328 {
2329 gst_structure_set(s, "interlace-mode", G_TYPE_STRING, "progressive", NULL);
2330 return;
2331 }
2332
2333 g_value_init(&interlace_formats, GST_TYPE_LIST);
2334
2335 /* Try twice - once for NONE, once for INTERLACED. */
2336 for (i = 0; i < G_N_ELEMENTS(formats); i++)
2337 {
2338 memset(&fmt, 0, sizeof(fmt));
2339 fmt.type = v4l2object->type;
2340 fmt.fmt.pix.width = width;
2341 fmt.fmt.pix.height = height;
2342 fmt.fmt.pix.pixelformat = pixelformat;
2343 fmt.fmt.pix.field = formats[i];
2344
2345 if (gst_aml_v4l2_object_try_fmt(v4l2object, &fmt) == 0 &&
2346 gst_aml_v4l2_object_get_interlace_mode(fmt.fmt.pix.field, &interlace_mode) && prev != interlace_mode)
2347 {
2348 GValue interlace_enum = {
2349 0,
2350 };
2351 const gchar *mode_string;
2352 g_value_init(&interlace_enum, G_TYPE_STRING);
2353 mode_string = gst_video_interlace_mode_to_string(interlace_mode);
2354 g_value_set_string(&interlace_enum, mode_string);
2355 gst_value_list_append_and_take_value(&interlace_formats,
2356 &interlace_enum);
2357 prev = interlace_mode;
2358 }
2359 }
2360
2361 if (gst_aml_v4l2src_value_simplify(&interlace_formats) || gst_value_list_get_size(&interlace_formats) > 0)
2362 gst_structure_take_value(s, "interlace-mode", &interlace_formats);
2363 else
2364 GST_WARNING_OBJECT(v4l2object, "Failed to determine interlace mode");
2365
2366 return;
2367}
2368
2369static void
2370gst_aml_v4l2_object_fill_colorimetry_list(GValue *list,
2371 GstVideoColorimetry *cinfo)
2372{
2373 GValue colorimetry = G_VALUE_INIT;
2374 guint size;
2375 guint i;
2376 gboolean found = FALSE;
2377
2378 g_value_init(&colorimetry, G_TYPE_STRING);
2379 g_value_take_string(&colorimetry, gst_video_colorimetry_to_string(cinfo));
xuesong.jiange1a19662022-06-21 20:30:22 +08002380 GST_DEBUG("fill colorimetry:%s into list", gst_video_colorimetry_to_string(cinfo));
xuesong.jiangae1548e2022-05-06 16:38:46 +08002381
2382 /* only insert if no duplicate */
2383 size = gst_value_list_get_size(list);
2384 for (i = 0; i < size; i++)
2385 {
2386 const GValue *tmp;
2387
2388 tmp = gst_value_list_get_value(list, i);
2389 if (gst_value_compare(&colorimetry, tmp) == GST_VALUE_EQUAL)
2390 {
2391 found = TRUE;
2392 break;
2393 }
2394 }
2395
2396 if (!found)
2397 gst_value_list_append_and_take_value(list, &colorimetry);
2398 else
2399 g_value_unset(&colorimetry);
2400}
2401
2402static void
2403gst_aml_v4l2_object_add_colorspace(GstAmlV4l2Object *v4l2object, GstStructure *s,
2404 guint32 width, guint32 height, guint32 pixelformat)
2405{
2406 struct v4l2_format fmt;
2407 GValue list = G_VALUE_INIT;
2408 GstVideoColorimetry cinfo;
2409 enum v4l2_colorspace req_cspace;
2410
2411 memset(&fmt, 0, sizeof(fmt));
2412 fmt.type = v4l2object->type;
2413 fmt.fmt.pix.width = width;
2414 fmt.fmt.pix.height = height;
2415 fmt.fmt.pix.pixelformat = pixelformat;
2416
2417 g_value_init(&list, GST_TYPE_LIST);
2418
2419 /* step 1: get device default colorspace and insert it first as
2420 * it should be the preferred one */
xuesong.jiange1a19662022-06-21 20:30:22 +08002421 GST_DEBUG("try for pixl format");
xuesong.jiangae1548e2022-05-06 16:38:46 +08002422 if (gst_aml_v4l2_object_try_fmt(v4l2object, &fmt) == 0)
2423 {
2424 if (gst_aml_v4l2_object_get_colorspace(&fmt, &cinfo))
2425 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2426 }
2427
2428 /* step 2: probe all colorspace other than default
2429 * We don't probe all colorspace, range, matrix and transfer combination to
2430 * avoid ioctl flooding which could greatly increase initialization time
2431 * with low-speed devices (UVC...) */
2432 for (req_cspace = V4L2_COLORSPACE_SMPTE170M;
2433 req_cspace <= V4L2_COLORSPACE_RAW; req_cspace++)
2434 {
xuesong.jiange1a19662022-06-21 20:30:22 +08002435 GST_DEBUG("try for pixl format in while loop :%d", req_cspace);
xuesong.jiangae1548e2022-05-06 16:38:46 +08002436 /* V4L2_COLORSPACE_BT878 is deprecated and shall not be used, so skip */
2437 if (req_cspace == V4L2_COLORSPACE_BT878)
2438 continue;
2439
2440 if (V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type))
2441 fmt.fmt.pix_mp.colorspace = req_cspace;
2442 else
2443 fmt.fmt.pix.colorspace = req_cspace;
2444
2445 if (gst_aml_v4l2_object_try_fmt(v4l2object, &fmt) == 0)
2446 {
xuesong.jiange1a19662022-06-21 20:30:22 +08002447 GST_DEBUG("try for pixl format in while loop :%d tried ok", req_cspace);
xuesong.jiangae1548e2022-05-06 16:38:46 +08002448 enum v4l2_colorspace colorspace;
2449
2450 if (V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type))
2451 colorspace = fmt.fmt.pix_mp.colorspace;
2452 else
2453 colorspace = fmt.fmt.pix.colorspace;
2454
2455 if (colorspace == req_cspace)
2456 {
2457 if (gst_aml_v4l2_object_get_colorspace(&fmt, &cinfo))
2458 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2459 }
2460 }
2461 }
2462
xuesong.jiang7b0882c2022-06-22 14:10:30 +08002463 GST_DEBUG("deal: caps with colorimetry 2,3,14,7");
xuesong.jiange1a19662022-06-21 20:30:22 +08002464 cinfo.range = 2;
2465 cinfo.matrix = 3;
2466 cinfo.transfer = 14;
2467 cinfo.primaries = 7;
2468 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2469
xuesong.jiang7b0882c2022-06-22 14:10:30 +08002470 GST_DEBUG("deal: caps with colorimetry 2,6,13,7");
2471 cinfo.range = 2;
2472 cinfo.matrix = 6;
2473 cinfo.transfer = 13;
2474 cinfo.primaries = 7;
2475 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2476
xuesong.jiang5c9aca72022-07-12 16:29:24 +08002477 GST_DEBUG("deal: caps with colorimetry 2,6,14,7");
2478 cinfo.range = 2;
2479 cinfo.matrix = 6;
2480 cinfo.transfer = 14;
2481 cinfo.primaries = 7;
2482 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2483
fei.dengccc89632022-07-15 19:10:17 +08002484 GST_DEBUG("deal: caps with colorimetry 2,6,0,7");
2485 cinfo.range = 2;
2486 cinfo.matrix = 6;
2487 cinfo.transfer = 0;
2488 cinfo.primaries = 7;
2489 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2490
fei.dengca85b052022-07-19 14:49:23 +08002491 GST_DEBUG("deal: caps with colorimetry 0,6,0,7");
2492 cinfo.range = 0;
2493 cinfo.matrix = 6;
2494 cinfo.transfer = 0;
2495 cinfo.primaries = 7;
2496 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2497
sheng.liua326d202022-07-20 14:15:34 +08002498 GST_DEBUG("deal: caps with colorimetry 2,3,0,0");
2499 cinfo.range = 2;
2500 cinfo.matrix = 3;
2501 cinfo.transfer = 0;
2502 cinfo.primaries = 0;
2503 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2504
hanghang.luoc54208e2023-09-22 02:43:54 +00002505 GST_DEBUG("deal: caps with colorimetry 2,6,14,0");
2506 cinfo.range = 2;
2507 cinfo.matrix = 6;
2508 cinfo.transfer = 14;
2509 cinfo.primaries = 0;
2510 gst_aml_v4l2_object_fill_colorimetry_list(&list, &cinfo);
2511
xuesong.jiangae1548e2022-05-06 16:38:46 +08002512 if (gst_value_list_get_size(&list) > 0)
2513 gst_structure_take_value(s, "colorimetry", &list);
2514 else
2515 g_value_unset(&list);
2516
2517 return;
2518}
2519
2520/* The frame interval enumeration code first appeared in Linux 2.6.19. */
2521static GstStructure *
2522gst_aml_v4l2_object_probe_caps_for_format_and_size(GstAmlV4l2Object *v4l2object,
2523 guint32 pixelformat,
2524 guint32 width, guint32 height, const GstStructure *template)
2525{
2526 gint fd = v4l2object->video_fd;
2527 struct v4l2_frmivalenum ival;
2528 guint32 num, denom;
2529 GstStructure *s;
2530 GValue rates = {
2531 0,
2532 };
2533
2534 memset(&ival, 0, sizeof(struct v4l2_frmivalenum));
2535 ival.index = 0;
2536 ival.pixel_format = pixelformat;
2537 ival.width = width;
2538 ival.height = height;
2539
2540 GST_LOG_OBJECT(v4l2object->dbg_obj,
2541 "get frame interval for %ux%u, %" GST_FOURCC_FORMAT, width, height,
2542 GST_FOURCC_ARGS(pixelformat));
2543
2544 /* keep in mind that v4l2 gives us frame intervals (durations); we invert the
2545 * fraction to get framerate */
2546 if (v4l2object->ioctl(fd, VIDIOC_ENUM_FRAMEINTERVALS, &ival) < 0)
2547 goto enum_frameintervals_failed;
2548
2549 if (ival.type == V4L2_FRMIVAL_TYPE_DISCRETE)
2550 {
2551 GValue rate = {
2552 0,
2553 };
2554
2555 g_value_init(&rates, GST_TYPE_LIST);
2556 g_value_init(&rate, GST_TYPE_FRACTION);
2557
2558 do
2559 {
2560 num = ival.discrete.numerator;
2561 denom = ival.discrete.denominator;
2562
2563 if (num > G_MAXINT || denom > G_MAXINT)
2564 {
2565 /* let us hope we don't get here... */
2566 num >>= 1;
2567 denom >>= 1;
2568 }
2569
2570 GST_LOG_OBJECT(v4l2object->dbg_obj, "adding discrete framerate: %d/%d",
2571 denom, num);
2572
2573 /* swap to get the framerate */
2574 gst_value_set_fraction(&rate, denom, num);
2575 gst_value_list_append_value(&rates, &rate);
2576
2577 ival.index++;
2578 } while (v4l2object->ioctl(fd, VIDIOC_ENUM_FRAMEINTERVALS, &ival) >= 0);
2579 }
2580 else if (ival.type == V4L2_FRMIVAL_TYPE_STEPWISE)
2581 {
2582 GValue min = {
2583 0,
2584 };
2585 GValue step = {
2586 0,
2587 };
2588 GValue max = {
2589 0,
2590 };
2591 gboolean added = FALSE;
2592 guint32 minnum, mindenom;
2593 guint32 maxnum, maxdenom;
2594
2595 g_value_init(&rates, GST_TYPE_LIST);
2596
2597 g_value_init(&min, GST_TYPE_FRACTION);
2598 g_value_init(&step, GST_TYPE_FRACTION);
2599 g_value_init(&max, GST_TYPE_FRACTION);
2600
2601 /* get the min */
2602 minnum = ival.stepwise.min.numerator;
2603 mindenom = ival.stepwise.min.denominator;
2604 if (minnum > G_MAXINT || mindenom > G_MAXINT)
2605 {
2606 minnum >>= 1;
2607 mindenom >>= 1;
2608 }
2609 GST_LOG_OBJECT(v4l2object->dbg_obj, "stepwise min frame interval: %d/%d",
2610 minnum, mindenom);
2611 gst_value_set_fraction(&min, minnum, mindenom);
2612
2613 /* get the max */
2614 maxnum = ival.stepwise.max.numerator;
2615 maxdenom = ival.stepwise.max.denominator;
2616 if (maxnum > G_MAXINT || maxdenom > G_MAXINT)
2617 {
2618 maxnum >>= 1;
2619 maxdenom >>= 1;
2620 }
2621
2622 GST_LOG_OBJECT(v4l2object->dbg_obj, "stepwise max frame interval: %d/%d",
2623 maxnum, maxdenom);
2624 gst_value_set_fraction(&max, maxnum, maxdenom);
2625
2626 /* get the step */
2627 num = ival.stepwise.step.numerator;
2628 denom = ival.stepwise.step.denominator;
2629 if (num > G_MAXINT || denom > G_MAXINT)
2630 {
2631 num >>= 1;
2632 denom >>= 1;
2633 }
2634
2635 if (num == 0 || denom == 0)
2636 {
2637 /* in this case we have a wrong fraction or no step, set the step to max
2638 * so that we only add the min value in the loop below */
2639 num = maxnum;
2640 denom = maxdenom;
2641 }
2642
2643 /* since we only have gst_value_fraction_subtract and not add, negate the
2644 * numerator */
2645 GST_LOG_OBJECT(v4l2object->dbg_obj, "stepwise step frame interval: %d/%d",
2646 num, denom);
2647 gst_value_set_fraction(&step, -num, denom);
2648
2649 while (gst_value_compare(&min, &max) != GST_VALUE_GREATER_THAN)
2650 {
2651 GValue rate = {
2652 0,
2653 };
2654
2655 num = gst_value_get_fraction_numerator(&min);
2656 denom = gst_value_get_fraction_denominator(&min);
2657 GST_LOG_OBJECT(v4l2object->dbg_obj, "adding stepwise framerate: %d/%d",
2658 denom, num);
2659
2660 /* invert to get the framerate */
2661 g_value_init(&rate, GST_TYPE_FRACTION);
2662 gst_value_set_fraction(&rate, denom, num);
2663 gst_value_list_append_value(&rates, &rate);
2664 added = TRUE;
2665
2666 /* we're actually adding because step was negated above. This is because
2667 * there is no _add function... */
2668 if (!gst_value_fraction_subtract(&min, &min, &step))
2669 {
2670 GST_WARNING_OBJECT(v4l2object->dbg_obj, "could not step fraction!");
2671 break;
2672 }
2673 }
2674 if (!added)
2675 {
2676 /* no range was added, leave the default range from the template */
2677 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2678 "no range added, leaving default");
2679 g_value_unset(&rates);
2680 }
2681 }
2682 else if (ival.type == V4L2_FRMIVAL_TYPE_CONTINUOUS)
2683 {
2684 guint32 maxnum, maxdenom;
2685
2686 g_value_init(&rates, GST_TYPE_FRACTION_RANGE);
2687
2688 num = ival.stepwise.min.numerator;
2689 denom = ival.stepwise.min.denominator;
2690 if (num > G_MAXINT || denom > G_MAXINT)
2691 {
2692 num >>= 1;
2693 denom >>= 1;
2694 }
2695
2696 maxnum = ival.stepwise.max.numerator;
2697 maxdenom = ival.stepwise.max.denominator;
2698 if (maxnum > G_MAXINT || maxdenom > G_MAXINT)
2699 {
2700 maxnum >>= 1;
2701 maxdenom >>= 1;
2702 }
2703
2704 GST_LOG_OBJECT(v4l2object->dbg_obj,
2705 "continuous frame interval %d/%d to %d/%d", maxdenom, maxnum, denom,
2706 num);
2707
2708 gst_value_set_fraction_range_full(&rates, maxdenom, maxnum, denom, num);
2709 }
2710 else
2711 {
2712 goto unknown_type;
2713 }
2714
2715return_data:
2716 s = gst_structure_copy(template);
2717 gst_structure_set(s, "width", G_TYPE_INT, (gint)width,
2718 "height", G_TYPE_INT, (gint)height, NULL);
2719
2720 gst_aml_v4l2_object_add_aspect_ratio(v4l2object, s);
2721
2722 if (!v4l2object->skip_try_fmt_probes)
2723 {
2724 gst_aml_v4l2_object_add_interlace_mode(v4l2object, s, width, height,
2725 pixelformat);
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08002726 // gst_aml_v4l2_object_add_colorspace(v4l2object, s, width, height, pixelformat);
xuesong.jiangae1548e2022-05-06 16:38:46 +08002727 }
2728
2729 if (G_IS_VALUE(&rates))
2730 {
2731 gst_aml_v4l2src_value_simplify(&rates);
2732 /* only change the framerate on the template when we have a valid probed new
2733 * value */
2734 gst_structure_take_value(s, "framerate", &rates);
2735 }
2736 else if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE ||
2737 v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
2738 {
2739 gst_structure_set(s, "framerate", GST_TYPE_FRACTION_RANGE, 0, 1, G_MAXINT,
2740 1, NULL);
2741 }
2742 return s;
2743
2744 /* ERRORS */
2745enum_frameintervals_failed:
2746{
2747 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
2748 "Unable to enumerate intervals for %" GST_FOURCC_FORMAT "@%ux%u",
2749 GST_FOURCC_ARGS(pixelformat), width, height);
2750 goto return_data;
2751}
2752unknown_type:
2753{
2754 /* I don't see how this is actually an error, we ignore the format then */
2755 GST_WARNING_OBJECT(v4l2object->dbg_obj,
2756 "Unknown frame interval type at %" GST_FOURCC_FORMAT "@%ux%u: %u",
2757 GST_FOURCC_ARGS(pixelformat), width, height, ival.type);
2758 return NULL;
2759}
2760}
2761
2762static gint
2763sort_by_frame_size(GstStructure *s1, GstStructure *s2)
2764{
2765 int w1, h1, w2, h2;
2766
2767 gst_structure_get_int(s1, "width", &w1);
2768 gst_structure_get_int(s1, "height", &h1);
2769 gst_structure_get_int(s2, "width", &w2);
2770 gst_structure_get_int(s2, "height", &h2);
2771
2772 /* I think it's safe to assume that this won't overflow for a while */
2773 return ((w2 * h2) - (w1 * h1));
2774}
2775
2776static void
2777gst_aml_v4l2_object_update_and_append(GstAmlV4l2Object *v4l2object,
2778 guint32 format, GstCaps *caps, GstStructure *s)
2779{
2780 GstStructure *alt_s = NULL;
2781
2782 /* Encoded stream on output buffer need to be parsed */
2783 if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT ||
2784 v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
2785 {
2786 gint i = 0;
2787
2788 for (; i < GST_AML_V4L2_FORMAT_COUNT; i++)
2789 {
2790 if (format == gst_aml_v4l2_formats[i].format &&
2791 gst_aml_v4l2_formats[i].flags & GST_V4L2_CODEC &&
2792 !(gst_aml_v4l2_formats[i].flags & GST_V4L2_NO_PARSE))
2793 {
2794 gst_structure_set(s, "parsed", G_TYPE_BOOLEAN, TRUE, NULL);
2795 break;
2796 }
2797 }
2798 }
2799
2800 if (v4l2object->has_alpha_component &&
2801 (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE ||
2802 v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE))
2803 {
2804 switch (format)
2805 {
2806 case V4L2_PIX_FMT_RGB32:
2807 alt_s = gst_structure_copy(s);
2808 gst_structure_set(alt_s, "format", G_TYPE_STRING, "ARGB", NULL);
2809 break;
2810 case V4L2_PIX_FMT_BGR32:
2811 alt_s = gst_structure_copy(s);
2812 gst_structure_set(alt_s, "format", G_TYPE_STRING, "BGRA", NULL);
2813 break;
2814 default:
2815 break;
2816 }
2817 }
2818
2819 gst_caps_append_structure(caps, s);
2820
2821 if (alt_s)
2822 gst_caps_append_structure(caps, alt_s);
2823}
2824
2825static GstCaps *
2826gst_aml_v4l2_object_probe_caps_for_format(GstAmlV4l2Object *v4l2object,
2827 guint32 pixelformat, const GstStructure *template)
2828{
2829 GstCaps *ret = gst_caps_new_empty();
2830 GstStructure *tmp;
2831 gint fd = v4l2object->video_fd;
2832 struct v4l2_frmsizeenum size;
2833 GList *results = NULL;
2834 guint32 w, h;
2835
2836 if (pixelformat == GST_MAKE_FOURCC('M', 'P', 'E', 'G'))
2837 {
2838 gst_caps_append_structure(ret, gst_structure_copy(template));
2839 return ret;
2840 }
2841
2842 memset(&size, 0, sizeof(struct v4l2_frmsizeenum));
2843 size.index = 0;
2844 size.pixel_format = pixelformat;
2845
2846 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
2847 "Enumerating frame sizes for %" GST_FOURCC_FORMAT,
2848 GST_FOURCC_ARGS(pixelformat));
2849
2850 if (v4l2object->ioctl(fd, VIDIOC_ENUM_FRAMESIZES, &size) < 0)
2851 goto enum_framesizes_failed;
2852
2853 if (size.type == V4L2_FRMSIZE_TYPE_DISCRETE)
2854 {
2855 do
2856 {
2857 GST_LOG_OBJECT(v4l2object->dbg_obj, "got discrete frame size %dx%d",
2858 size.discrete.width, size.discrete.height);
2859
2860 w = MIN(size.discrete.width, G_MAXINT);
2861 h = MIN(size.discrete.height, G_MAXINT);
2862
2863 if (w && h)
2864 {
2865 tmp =
2866 gst_aml_v4l2_object_probe_caps_for_format_and_size(v4l2object,
2867 pixelformat, w, h, template);
2868
2869 if (tmp)
2870 results = g_list_prepend(results, tmp);
2871 }
2872
2873 size.index++;
2874 } while (v4l2object->ioctl(fd, VIDIOC_ENUM_FRAMESIZES, &size) >= 0);
2875 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
2876 "done iterating discrete frame sizes");
2877 }
2878 else if (size.type == V4L2_FRMSIZE_TYPE_STEPWISE)
2879 {
2880 guint32 maxw, maxh, step_w, step_h;
2881
2882 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "we have stepwise frame sizes:");
2883 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min width: %d",
2884 size.stepwise.min_width);
2885 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min height: %d",
2886 size.stepwise.min_height);
2887 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "max width: %d",
2888 size.stepwise.max_width);
2889 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min height: %d",
2890 size.stepwise.max_height);
2891 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "step width: %d",
2892 size.stepwise.step_width);
2893 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "step height: %d",
2894 size.stepwise.step_height);
2895
2896 w = MAX(size.stepwise.min_width, 1);
2897 h = MAX(size.stepwise.min_height, 1);
2898 maxw = MIN(size.stepwise.max_width, G_MAXINT);
2899 maxh = MIN(size.stepwise.max_height, G_MAXINT);
2900
hanghang.luo9edfc7d2023-05-17 07:01:05 +00002901 /* in this position,updating resolution only to pass the negotiation
2902 * actually, the details about resolution refer to function:
2903 * gst_aml_v4l2_object_set_format_full for checking.
2904 */
2905 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "update maxw_maxh to MAX(maxw,maxh)_MAX(maxw,maxh)");
2906 maxh = MAX (maxw, maxh);
2907 maxw = maxh;
2908
xuesong.jiangae1548e2022-05-06 16:38:46 +08002909 step_w = MAX(size.stepwise.step_width, 1);
2910 step_h = MAX(size.stepwise.step_height, 1);
2911
2912 /* FIXME: check for sanity and that min/max are multiples of the steps */
2913
2914 /* we only query details for the max width/height since it's likely the
2915 * most restricted if there are any resolution-dependent restrictions */
2916 tmp = gst_aml_v4l2_object_probe_caps_for_format_and_size(v4l2object,
2917 pixelformat, maxw, maxh, template);
2918
2919 if (tmp)
2920 {
2921 GValue step_range = G_VALUE_INIT;
2922
2923 g_value_init(&step_range, GST_TYPE_INT_RANGE);
2924 gst_value_set_int_range_step(&step_range, w, maxw, step_w);
2925 gst_structure_set_value(tmp, "width", &step_range);
2926
2927 gst_value_set_int_range_step(&step_range, h, maxh, step_h);
2928 gst_structure_take_value(tmp, "height", &step_range);
2929
2930 /* no point using the results list here, since there's only one struct */
2931 gst_aml_v4l2_object_update_and_append(v4l2object, pixelformat, ret, tmp);
2932 }
2933 }
2934 else if (size.type == V4L2_FRMSIZE_TYPE_CONTINUOUS)
2935 {
2936 guint32 maxw, maxh;
2937
2938 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "we have continuous frame sizes:");
2939 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min width: %d",
2940 size.stepwise.min_width);
2941 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min height: %d",
2942 size.stepwise.min_height);
2943 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "max width: %d",
2944 size.stepwise.max_width);
2945 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "min height: %d",
2946 size.stepwise.max_height);
2947
2948 w = MAX(size.stepwise.min_width, 1);
2949 h = MAX(size.stepwise.min_height, 1);
2950 maxw = MIN(size.stepwise.max_width, G_MAXINT);
2951 maxh = MIN(size.stepwise.max_height, G_MAXINT);
2952
2953 tmp =
2954 gst_aml_v4l2_object_probe_caps_for_format_and_size(v4l2object, pixelformat,
2955 w, h, template);
2956 if (tmp)
2957 {
2958 gst_structure_set(tmp, "width", GST_TYPE_INT_RANGE, (gint)w,
2959 (gint)maxw, "height", GST_TYPE_INT_RANGE, (gint)h, (gint)maxh,
2960 NULL);
2961
2962 /* no point using the results list here, since there's only one struct */
2963 gst_aml_v4l2_object_update_and_append(v4l2object, pixelformat, ret, tmp);
2964 }
2965 }
2966 else
2967 {
2968 goto unknown_type;
2969 }
2970
2971 /* we use an intermediary list to store and then sort the results of the
2972 * probing because we can't make any assumptions about the order in which
2973 * the driver will give us the sizes, but we want the final caps to contain
2974 * the results starting with the highest resolution and having the lowest
2975 * resolution last, since order in caps matters for things like fixation. */
2976 results = g_list_sort(results, (GCompareFunc)sort_by_frame_size);
2977 while (results != NULL)
2978 {
2979 gst_aml_v4l2_object_update_and_append(v4l2object, pixelformat, ret,
2980 results->data);
2981 results = g_list_delete_link(results, results);
2982 }
2983
2984 if (gst_caps_is_empty(ret))
2985 goto enum_framesizes_no_results;
2986
2987 return ret;
2988
2989 /* ERRORS */
2990enum_framesizes_failed:
2991{
2992 /* I don't see how this is actually an error */
2993 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
2994 "Failed to enumerate frame sizes for pixelformat %" GST_FOURCC_FORMAT
2995 " (%s)",
2996 GST_FOURCC_ARGS(pixelformat), g_strerror(errno));
2997 goto default_frame_sizes;
2998}
2999enum_framesizes_no_results:
3000{
3001 /* it's possible that VIDIOC_ENUM_FRAMESIZES is defined but the driver in
3002 * question doesn't actually support it yet */
3003 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
3004 "No results for pixelformat %" GST_FOURCC_FORMAT
3005 " enumerating frame sizes, trying fallback",
3006 GST_FOURCC_ARGS(pixelformat));
3007 goto default_frame_sizes;
3008}
3009unknown_type:
3010{
3011 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3012 "Unknown frame sizeenum type for pixelformat %" GST_FOURCC_FORMAT
3013 ": %u",
3014 GST_FOURCC_ARGS(pixelformat), size.type);
3015 goto default_frame_sizes;
3016}
3017
3018default_frame_sizes:
3019{
bo.xiao34e36202024-07-17 16:04:01 +08003020 gint min_w, max_w, min_h, max_h;
3021
3022#ifdef DELETE_FOR_LGE
3023 gint fix_num = 0, fix_denom = 0;
3024#endif
xuesong.jiangae1548e2022-05-06 16:38:46 +08003025
3026 /* This code is for Linux < 2.6.19 */
3027 min_w = min_h = 1;
3028 max_w = max_h = GST_AML_V4L2_MAX_SIZE;
3029 if (!gst_aml_v4l2_object_get_nearest_size(v4l2object, pixelformat, &min_w,
3030 &min_h))
3031 {
3032 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3033 "Could not probe minimum capture size for pixelformat %" GST_FOURCC_FORMAT, GST_FOURCC_ARGS(pixelformat));
3034 }
3035 if (!gst_aml_v4l2_object_get_nearest_size(v4l2object, pixelformat, &max_w,
3036 &max_h))
3037 {
3038 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3039 "Could not probe maximum capture size for pixelformat %" GST_FOURCC_FORMAT, GST_FOURCC_ARGS(pixelformat));
3040 }
3041
3042 tmp = gst_structure_copy(template);
hanghang.luo3128f102022-08-18 10:36:19 +08003043#ifdef DELETE_FOR_LGE
xuesong.jiangae1548e2022-05-06 16:38:46 +08003044 if (fix_num)
3045 {
3046 gst_structure_set(tmp, "framerate", GST_TYPE_FRACTION, fix_num,
3047 fix_denom, NULL);
3048 }
hanghang.luo3128f102022-08-18 10:36:19 +08003049 else
3050#endif
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08003051 if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE ||
3052 v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
xuesong.jiangae1548e2022-05-06 16:38:46 +08003053 {
3054 /* if norm can't be used, copy the template framerate */
3055 gst_structure_set(tmp, "framerate", GST_TYPE_FRACTION_RANGE, 0, 1,
3056 G_MAXINT, 1, NULL);
3057 }
3058
3059 if (min_w == max_w)
3060 gst_structure_set(tmp, "width", G_TYPE_INT, max_w, NULL);
3061 else
3062 gst_structure_set(tmp, "width", GST_TYPE_INT_RANGE, min_w, max_w, NULL);
3063
3064 if (min_h == max_h)
3065 gst_structure_set(tmp, "height", G_TYPE_INT, max_h, NULL);
3066 else
3067 gst_structure_set(tmp, "height", GST_TYPE_INT_RANGE, min_h, max_h, NULL);
3068
3069 gst_aml_v4l2_object_add_aspect_ratio(v4l2object, tmp);
3070
3071 if (!v4l2object->skip_try_fmt_probes)
3072 {
3073 /* We could consider setting interlace mode from min and max. */
3074 gst_aml_v4l2_object_add_interlace_mode(v4l2object, tmp, max_w, max_h,
3075 pixelformat);
3076 /* We could consider to check colorspace for min too, in case it depends on
3077 * the size. But in this case, min and max could not be enough */
3078 gst_aml_v4l2_object_add_colorspace(v4l2object, tmp, max_w, max_h,
3079 pixelformat);
3080 }
3081
3082 gst_aml_v4l2_object_update_and_append(v4l2object, pixelformat, ret, tmp);
3083 return ret;
3084}
3085}
3086
3087static gboolean
3088gst_aml_v4l2_object_get_nearest_size(GstAmlV4l2Object *v4l2object,
3089 guint32 pixelformat, gint *width, gint *height)
3090{
3091 struct v4l2_format fmt;
3092 gboolean ret = FALSE;
3093 GstVideoInterlaceMode interlace_mode;
3094
3095 g_return_val_if_fail(width != NULL, FALSE);
3096 g_return_val_if_fail(height != NULL, FALSE);
3097
3098 GST_LOG_OBJECT(v4l2object->dbg_obj,
3099 "getting nearest size to %dx%d with format %" GST_FOURCC_FORMAT,
3100 *width, *height, GST_FOURCC_ARGS(pixelformat));
3101
3102 memset(&fmt, 0, sizeof(struct v4l2_format));
3103
3104 /* get size delimiters */
3105 memset(&fmt, 0, sizeof(fmt));
3106 fmt.type = v4l2object->type;
3107 fmt.fmt.pix.width = *width;
3108 fmt.fmt.pix.height = *height;
3109 fmt.fmt.pix.pixelformat = pixelformat;
3110 fmt.fmt.pix.field = V4L2_FIELD_ANY;
3111
3112 if (gst_aml_v4l2_object_try_fmt(v4l2object, &fmt) < 0)
3113 goto error;
3114
3115 GST_LOG_OBJECT(v4l2object->dbg_obj,
3116 "got nearest size %dx%d", fmt.fmt.pix.width, fmt.fmt.pix.height);
3117
3118 *width = fmt.fmt.pix.width;
3119 *height = fmt.fmt.pix.height;
3120
3121 if (!gst_aml_v4l2_object_get_interlace_mode(fmt.fmt.pix.field, &interlace_mode))
3122 {
3123 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3124 "Unsupported field type for %" GST_FOURCC_FORMAT "@%ux%u: %u",
3125 GST_FOURCC_ARGS(pixelformat), *width, *height, fmt.fmt.pix.field);
3126 goto error;
3127 }
3128
3129 ret = TRUE;
3130
3131error:
3132 if (!ret)
3133 {
3134 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3135 "Unable to try format: %s", g_strerror(errno));
3136 }
3137
3138 return ret;
3139}
3140
3141static gboolean
3142gst_aml_v4l2_object_is_dmabuf_supported(GstAmlV4l2Object *v4l2object)
3143{
3144 gboolean ret = TRUE;
3145 struct v4l2_exportbuffer expbuf = {
3146 .type = v4l2object->type,
3147 .index = -1,
3148 .plane = -1,
3149 .flags = O_CLOEXEC | O_RDWR,
3150 };
3151
3152 if (v4l2object->fmtdesc->flags & V4L2_FMT_FLAG_EMULATED)
3153 {
3154 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3155 "libv4l2 converter detected, disabling DMABuf");
3156 ret = FALSE;
3157 }
3158
3159 /* Expected to fail, but ENOTTY tells us that it is not implemented. */
3160 v4l2object->ioctl(v4l2object->video_fd, VIDIOC_EXPBUF, &expbuf);
3161 if (errno == ENOTTY)
3162 ret = FALSE;
3163
3164 return ret;
3165}
3166
3167static gboolean
3168gst_aml_v4l2_object_setup_pool(GstAmlV4l2Object *v4l2object, GstCaps *caps)
3169{
3170 GstAmlV4l2IOMode mode;
3171
3172 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "initializing the %s system",
3173 V4L2_TYPE_IS_OUTPUT(v4l2object->type) ? "output" : "capture");
3174
3175 GST_AML_V4L2_CHECK_OPEN(v4l2object);
3176 GST_AML_V4L2_CHECK_NOT_ACTIVE(v4l2object);
3177
3178 /* find transport */
3179 mode = v4l2object->req_mode;
3180
3181 if (v4l2object->device_caps & V4L2_CAP_READWRITE)
3182 {
3183 if (v4l2object->req_mode == GST_V4L2_IO_AUTO)
3184 mode = GST_V4L2_IO_RW;
3185 }
3186 else if (v4l2object->req_mode == GST_V4L2_IO_RW)
3187 goto method_not_supported;
3188
3189 if (v4l2object->device_caps & V4L2_CAP_STREAMING)
3190 {
3191 if (v4l2object->req_mode == GST_V4L2_IO_AUTO)
3192 {
3193 if (!V4L2_TYPE_IS_OUTPUT(v4l2object->type) &&
3194 gst_aml_v4l2_object_is_dmabuf_supported(v4l2object))
3195 {
3196 mode = GST_V4L2_IO_DMABUF;
3197 }
3198 else
3199 {
3200 mode = GST_V4L2_IO_MMAP;
3201 }
3202 }
3203 }
3204 else if (v4l2object->req_mode == GST_V4L2_IO_MMAP ||
3205 v4l2object->req_mode == GST_V4L2_IO_DMABUF)
3206 goto method_not_supported;
3207
3208 /* if still no transport selected, error out */
3209 if (mode == GST_V4L2_IO_AUTO)
3210 goto no_supported_capture_method;
3211
3212 GST_INFO_OBJECT(v4l2object->dbg_obj, "accessing buffers via mode %d", mode);
3213 v4l2object->mode = mode;
3214
3215 /* If min_buffers is not set, the driver either does not support the control or
3216 it has not been asked yet via propose_allocation/decide_allocation. */
3217 if (!v4l2object->min_buffers)
3218 gst_aml_v4l2_get_driver_min_buffers(v4l2object);
3219
3220 /* Map the buffers */
3221 GST_LOG_OBJECT(v4l2object->dbg_obj, "initiating buffer pool");
3222
3223 if (!(v4l2object->pool = gst_aml_v4l2_buffer_pool_new(v4l2object, caps)))
3224 goto buffer_pool_new_failed;
3225
3226 GST_AML_V4L2_SET_ACTIVE(v4l2object);
3227
3228 return TRUE;
3229
3230 /* ERRORS */
3231buffer_pool_new_failed:
3232{
3233 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, READ,
3234 (_("Could not map buffers from device '%s'"),
3235 v4l2object->videodev),
3236 ("Failed to create buffer pool: %s", g_strerror(errno)));
3237 return FALSE;
3238}
3239method_not_supported:
3240{
3241 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, READ,
3242 (_("The driver of device '%s' does not support the IO method %d"),
3243 v4l2object->videodev, mode),
3244 (NULL));
3245 return FALSE;
3246}
3247no_supported_capture_method:
3248{
3249 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, READ,
3250 (_("The driver of device '%s' does not support any known IO "
3251 "method."),
3252 v4l2object->videodev),
3253 (NULL));
3254 return FALSE;
3255}
3256}
3257
3258static void
3259gst_aml_v4l2_object_set_stride(GstVideoInfo *info, GstVideoAlignment *align,
3260 gint plane, gint stride)
3261{
3262 const GstVideoFormatInfo *finfo = info->finfo;
3263
3264 if (GST_VIDEO_FORMAT_INFO_IS_TILED(finfo))
3265 {
3266 gint x_tiles, y_tiles, ws, hs, tile_height, padded_height;
3267
3268 ws = GST_VIDEO_FORMAT_INFO_TILE_WS(finfo);
3269 hs = GST_VIDEO_FORMAT_INFO_TILE_HS(finfo);
3270 tile_height = 1 << hs;
3271
3272 padded_height = GST_VIDEO_FORMAT_INFO_SCALE_HEIGHT(finfo, plane,
3273 info->height + align->padding_top + align->padding_bottom);
3274 padded_height = GST_ROUND_UP_N(padded_height, tile_height);
3275
3276 x_tiles = stride >> ws;
3277 y_tiles = padded_height >> hs;
3278 info->stride[plane] = GST_VIDEO_TILE_MAKE_STRIDE(x_tiles, y_tiles);
3279 }
3280 else
3281 {
3282 info->stride[plane] = stride;
3283 }
3284}
3285
3286static void
3287gst_aml_v4l2_object_extrapolate_info(GstAmlV4l2Object *v4l2object,
3288 GstVideoInfo *info, GstVideoAlignment *align, gint stride)
3289{
3290 const GstVideoFormatInfo *finfo = info->finfo;
3291 gint i, estride, padded_height;
3292 gsize offs = 0;
3293
3294 g_return_if_fail(v4l2object->n_v4l2_planes == 1);
3295
3296 padded_height = info->height + align->padding_top + align->padding_bottom;
3297
3298 for (i = 0; i < finfo->n_planes; i++)
3299 {
3300 estride = gst_aml_v4l2_object_extrapolate_stride(finfo, i, stride);
3301
3302 gst_aml_v4l2_object_set_stride(info, align, i, estride);
3303
3304 info->offset[i] = offs;
3305 offs += estride *
3306 GST_VIDEO_FORMAT_INFO_SCALE_HEIGHT(finfo, i, padded_height);
3307
3308 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
3309 "Extrapolated for plane %d with base stride %d: "
3310 "stride %d, offset %" G_GSIZE_FORMAT,
3311 i, stride, info->stride[i],
3312 info->offset[i]);
3313 }
3314
3315 /* Update the image size according the amount of data we are going to
3316 * read/write. This workaround bugs in driver where the sizeimage provided
3317 * by TRY/S_FMT represent the buffer length (maximum size) rather then the expected
3318 * bytesused (buffer size). */
3319 if (offs < info->size)
3320 info->size = offs;
3321}
3322
3323static void
3324gst_aml_v4l2_object_save_format(GstAmlV4l2Object *v4l2object,
3325 struct v4l2_fmtdesc *fmtdesc, struct v4l2_format *format,
3326 GstVideoInfo *info, GstVideoAlignment *align)
3327{
3328 const GstVideoFormatInfo *finfo = info->finfo;
3329 gboolean standard_stride = TRUE;
3330 gint stride, pstride, padded_width, padded_height, i;
3331
3332 if (GST_VIDEO_INFO_FORMAT(info) == GST_VIDEO_FORMAT_ENCODED)
3333 {
3334 v4l2object->n_v4l2_planes = 1;
3335 info->size = format->fmt.pix.sizeimage;
3336 goto store_info;
3337 }
3338
3339 /* adjust right padding */
3340 if (V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type))
3341 stride = format->fmt.pix_mp.plane_fmt[0].bytesperline;
3342 else
3343 stride = format->fmt.pix.bytesperline;
3344
3345 pstride = GST_VIDEO_FORMAT_INFO_PSTRIDE(finfo, 0);
3346 if (pstride)
3347 {
3348 padded_width = stride / pstride;
3349 }
3350 else
3351 {
3352 /* pstride can be 0 for complex formats */
3353 GST_WARNING_OBJECT(v4l2object->element,
3354 "format %s has a pstride of 0, cannot compute padded with",
3355 gst_video_format_to_string(GST_VIDEO_INFO_FORMAT(info)));
3356 padded_width = stride;
3357 }
3358
3359 if (padded_width < format->fmt.pix.width)
3360 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3361 "Driver bug detected, stride (%d) is too small for the width (%d)",
3362 padded_width, format->fmt.pix.width);
3363
3364 align->padding_right = padded_width - info->width - align->padding_left;
3365
3366 /* adjust bottom padding */
3367 padded_height = format->fmt.pix.height;
3368
3369 if (GST_VIDEO_FORMAT_INFO_IS_TILED(finfo))
3370 {
3371 guint hs, tile_height;
3372
3373 hs = GST_VIDEO_FORMAT_INFO_TILE_HS(finfo);
3374 tile_height = 1 << hs;
3375
3376 padded_height = GST_ROUND_UP_N(padded_height, tile_height);
3377 }
3378
3379 align->padding_bottom = padded_height - info->height - align->padding_top;
3380
3381 /* setup the strides and offset */
3382 if (V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type))
3383 {
3384 struct v4l2_pix_format_mplane *pix_mp = &format->fmt.pix_mp;
3385
3386 /* figure out the frame layout */
3387 v4l2object->n_v4l2_planes = MAX(1, pix_mp->num_planes);
3388 info->size = 0;
3389 for (i = 0; i < v4l2object->n_v4l2_planes; i++)
3390 {
3391 stride = pix_mp->plane_fmt[i].bytesperline;
3392
3393 if (info->stride[i] != stride)
3394 standard_stride = FALSE;
3395
3396 gst_aml_v4l2_object_set_stride(info, align, i, stride);
3397 info->offset[i] = info->size;
3398 info->size += pix_mp->plane_fmt[i].sizeimage;
3399 }
3400
3401 /* Extrapolate stride if planar format are being set in 1 v4l2 plane */
3402 if (v4l2object->n_v4l2_planes < finfo->n_planes)
3403 {
3404 stride = format->fmt.pix_mp.plane_fmt[0].bytesperline;
3405 gst_aml_v4l2_object_extrapolate_info(v4l2object, info, align, stride);
3406 }
3407 }
3408 else
3409 {
3410 /* only one plane in non-MPLANE mode */
3411 v4l2object->n_v4l2_planes = 1;
3412 info->size = format->fmt.pix.sizeimage;
3413 stride = format->fmt.pix.bytesperline;
3414
3415 if (info->stride[0] != stride)
3416 standard_stride = FALSE;
3417
3418 gst_aml_v4l2_object_extrapolate_info(v4l2object, info, align, stride);
3419 }
3420
3421 /* adjust the offset to take into account left and top */
3422 if (GST_VIDEO_FORMAT_INFO_IS_TILED(finfo))
3423 {
3424 if ((align->padding_left + align->padding_top) > 0)
3425 GST_WARNING_OBJECT(v4l2object->dbg_obj,
3426 "Left and top padding is not permitted for tiled formats");
3427 }
3428 else
3429 {
3430 for (i = 0; i < finfo->n_planes; i++)
3431 {
3432 gint vedge, hedge;
3433
3434 /* FIXME we assume plane as component as this is true for all supported
3435 * format we support. */
3436
3437 hedge = GST_VIDEO_FORMAT_INFO_SCALE_WIDTH(finfo, i, align->padding_left);
3438 vedge = GST_VIDEO_FORMAT_INFO_SCALE_HEIGHT(finfo, i, align->padding_top);
3439
3440 info->offset[i] += (vedge * info->stride[i]) +
3441 (hedge * GST_VIDEO_INFO_COMP_PSTRIDE(info, i));
3442 }
3443 }
3444
3445store_info:
3446 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Got sizeimage %" G_GSIZE_FORMAT,
3447 info->size);
3448
3449 /* to avoid copies we need video meta if there is padding */
3450 v4l2object->need_video_meta =
3451 ((align->padding_top + align->padding_left + align->padding_right +
3452 align->padding_bottom) != 0);
3453
3454 /* ... or if stride is non "standard" */
3455 if (!standard_stride)
3456 v4l2object->need_video_meta = TRUE;
3457
3458 /* ... or also video meta if we use multiple, non-contiguous, planes */
3459 if (v4l2object->n_v4l2_planes > 1)
3460 v4l2object->need_video_meta = TRUE;
3461
3462 v4l2object->info = *info;
3463 v4l2object->align = *align;
3464 v4l2object->format = *format;
3465 v4l2object->fmtdesc = fmtdesc;
3466
3467 /* if we have a framerate pre-calculate duration */
3468 if (info->fps_n > 0 && info->fps_d > 0)
3469 {
3470 v4l2object->duration = gst_util_uint64_scale_int(GST_SECOND, info->fps_d,
3471 info->fps_n);
3472 }
3473 else
3474 {
3475 v4l2object->duration = GST_CLOCK_TIME_NONE;
3476 }
3477}
3478
3479gint gst_aml_v4l2_object_extrapolate_stride(const GstVideoFormatInfo *finfo,
3480 gint plane, gint stride)
3481{
3482 gint estride;
3483
3484 switch (finfo->format)
3485 {
3486 case GST_VIDEO_FORMAT_NV12:
3487 case GST_VIDEO_FORMAT_NV12_64Z32:
3488 case GST_VIDEO_FORMAT_NV21:
3489 case GST_VIDEO_FORMAT_NV16:
3490 case GST_VIDEO_FORMAT_NV61:
3491 case GST_VIDEO_FORMAT_NV24:
3492 estride = (plane == 0 ? 1 : 2) *
3493 GST_VIDEO_FORMAT_INFO_SCALE_WIDTH(finfo, plane, stride);
3494 break;
3495 default:
3496 estride = GST_VIDEO_FORMAT_INFO_SCALE_WIDTH(finfo, plane, stride);
3497 break;
3498 }
3499
3500 return estride;
3501}
3502
3503static gboolean
3504gst_aml_v4l2_video_colorimetry_matches(const GstVideoColorimetry *cinfo,
3505 const gchar *color)
3506{
3507 GstVideoColorimetry ci;
3508 static const GstVideoColorimetry ci_likely_jpeg = {
3509 GST_VIDEO_COLOR_RANGE_0_255, GST_VIDEO_COLOR_MATRIX_BT601,
3510 GST_VIDEO_TRANSFER_UNKNOWN, GST_VIDEO_COLOR_PRIMARIES_UNKNOWN};
3511 static const GstVideoColorimetry ci_jpeg = {
3512 GST_VIDEO_COLOR_RANGE_0_255, GST_VIDEO_COLOR_MATRIX_BT601,
3513 GST_VIDEO_TRANSFER_SRGB, GST_VIDEO_COLOR_PRIMARIES_BT709};
3514
3515 if (!gst_video_colorimetry_from_string(&ci, color))
3516 return FALSE;
3517
3518 if (gst_video_colorimetry_is_equal(&ci, cinfo))
3519 return TRUE;
3520
3521 /* Allow 1:4:0:0 (produced by jpegdec) if the device expects 1:4:7:1 */
3522 if (gst_video_colorimetry_is_equal(&ci, &ci_likely_jpeg) && gst_video_colorimetry_is_equal(cinfo, &ci_jpeg))
3523 return TRUE;
3524
3525 return FALSE;
3526}
3527
hanghang.luo6a5bdff2024-04-15 06:29:43 +00003528static gboolean needSpecConfigForFg(GstAmlV4l2Object *v4l2object)
3529{
3530 gboolean result= FALSE;
bo.xiao34e36202024-07-17 16:04:01 +08003531 int fd = -1;
hanghang.luo6a5bdff2024-04-15 06:29:43 +00003532 char valstr[64];
3533 const char* path= "/sys/class/video/film_grain_support";
3534 uint32_t val= 0;
hanghang.luo6a5bdff2024-04-15 06:29:43 +00003535 struct v4l2_control ctl;
3536
3537 GST_LOG("configForFilmGrain: enter");
bo.xiao34e36202024-07-17 16:04:01 +08003538 fd = open(path, O_RDONLY|O_CLOEXEC);
hanghang.luo6a5bdff2024-04-15 06:29:43 +00003539 if ( fd < 0 )
3540 {
3541 GST_DEBUG("unable to open file (%s)", path);
3542 goto exit;
3543 }
3544
3545 memset(valstr, 0, sizeof(valstr));
bo.xiao34e36202024-07-17 16:04:01 +08003546 if (read(fd, valstr, sizeof(valstr) - 1) == -1 )
3547 {
3548 GST_DEBUG("unable to read fg flag");
3549 goto exit;
3550 }
3551
hanghang.luo6a5bdff2024-04-15 06:29:43 +00003552 valstr[strlen(valstr)] = '\0';
3553
3554 if ( sscanf(valstr, "%u", &val) < 1)
3555 {
3556 GST_DEBUG("unable to get flag from: (%s)", valstr);
3557 goto exit;
3558 }
3559
3560 GST_LOG("got film_grain_support:%d from node", val);
3561 if (val != 0)
3562 {
3563 goto exit;
3564 }
3565
3566 memset( &ctl, 0, sizeof(ctl));
3567 ctl.id= AML_V4L2_GET_FILMGRAIN_INFO;
3568 v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_CTRL, ctl);
3569 GST_LOG("got VIDIOC_G_CTRL value: %d", ctl.value);
3570 if (ctl.value == 0)
3571 {
3572 goto exit;
3573 }
3574
3575 result= TRUE;
3576
3577exit:
3578 if ( fd >= 0 )
3579 {
3580 close(fd);
3581 }
3582 GST_LOG("configForFilmGrain: exit: result %d", result);
3583 return result;
3584}
hanghang.luobfc63f82024-07-05 11:04:56 +08003585
3586static gboolean
3587get_amlogic_vdec_parm(GstAmlV4l2Object *v4l2object, struct aml_dec_params *decParm)
3588{
3589 struct v4l2_ext_control control;
3590 struct v4l2_ext_controls ctrls;
3591 gboolean use_ext_config = FALSE;
3592 int major = 0,minor = 0;
3593 struct utsname info;
3594 if (uname(&info) || sscanf(info.release, "%d.%d", &major, &minor) <= 0)
3595 {
3596 GST_DEBUG("get linux version failed");
3597 return FALSE;
3598 }
3599 GST_DEBUG("linux major version %d %d", major,minor);
3600 use_ext_config = ((major == 5 && minor >= 15) || major >= 6) ? TRUE: FALSE;
3601 if (use_ext_config)
3602 {
3603 memset(&ctrls, 0, sizeof(ctrls));
3604 memset(&control, 0, sizeof(control));
3605 control.id = AML_V4L2_DEC_PARMS_CONFIG;
3606 control.ptr = decParm;
3607 control.size = sizeof(struct aml_dec_params);
3608 ctrls.count = 1;
3609 ctrls.controls = &control;
3610 if (v4l2object->ioctl( v4l2object->video_fd, VIDIOC_G_EXT_CTRLS, &ctrls ) <0)
3611 {
3612 GST_ERROR_OBJECT(v4l2object->dbg_obj, "get vdec parm fail");
3613 return FALSE;
3614 }
3615 GST_DEBUG("dw: %d",decParm->cfg.double_write_mode);
3616 GST_DEBUG("flag: %d",decParm->cfg.metadata_config_flag);
3617 GST_DEBUG("status: %d",decParm->parms_status);
3618 GST_DEBUG("margin: %d",decParm->cfg.ref_buf_margin);
3619 }
3620 else
3621 {
3622 struct v4l2_streamparm streamparm;
3623 memset(&streamparm, 0x00, sizeof(struct v4l2_streamparm));
3624 streamparm.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
3625 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_PARM, &streamparm) < 0)
3626 {
3627 GST_ERROR_OBJECT(v4l2object->dbg_obj, "get vdec parm fail");
3628 return FALSE;
3629 }
3630 decParm = (struct aml_dec_params *)streamparm.parm.raw_data;
3631 }
3632 return TRUE;
3633}
3634
bo.xiao34e36202024-07-17 16:04:01 +08003635static int gst_aml_config_dw(GstAmlV4l2Object *v4l2object, guint32 pixFormat, guint width, guint height, gboolean interlace)
3636{
3637 const char *env_dw;
3638 int double_write = VDEC_DW_NO_AFBC;
3639
3640 GST_DEBUG("pixFormat: %d", pixFormat);
3641 switch (pixFormat)
3642 {
3643 case V4L2_PIX_FMT_MPEG:
3644 case V4L2_PIX_FMT_MPEG1:
3645 case V4L2_PIX_FMT_MPEG2:
3646 case V4L2_PIX_FMT_MPEG4:
3647 double_write = VDEC_DW_NO_AFBC;
3648 break;
3649 case V4L2_PIX_FMT_H264:
3650 {
3651 if (width > 1920 && height > 1080 && interlace)
3652 double_write = VDEC_DW_AFBC_1_4_DW;
3653 else
3654 double_write = VDEC_DW_NO_AFBC;
3655 break;
3656 }
3657 case V4L2_PIX_FMT_HEVC:
3658 double_write = VDEC_DW_AFBC_AUTO_1_4;
3659 if (interlace)
3660 double_write = VDEC_DW_AFBC_1_1_DW;
3661 if (v4l2object->low_memory_mode)
3662 double_write = VDEC_DW_AFBC_ONLY;
3663 break;
3664 case V4L2_PIX_FMT_VP9:
3665 case V4L2_PIX_FMT_AV1:
3666 double_write = v4l2object->low_memory_mode ? VDEC_DW_AFBC_ONLY:VDEC_DW_AFBC_AUTO_1_4;
3667 break;
3668 default:
3669 GST_WARNING("unknown video format %d", pixFormat);
3670 break;
3671 }
3672
3673 env_dw = getenv("V4L2_SET_AMLOGIC_DW_MODE");
3674 if (env_dw)
3675 double_write = atoi(env_dw);
3676
3677 return double_write;
3678}
hanghang.luobfc63f82024-07-05 11:04:56 +08003679
xuesong.jiangae1548e2022-05-06 16:38:46 +08003680static void
fei.deng7c3d67f2022-11-09 11:06:05 +08003681set_amlogic_vdec_parm(GstAmlV4l2Object *v4l2object, struct v4l2_streamparm *streamparm, GstCaps *caps, guint32 pixFormat)
xuesong.jiangae1548e2022-05-06 16:38:46 +08003682{
3683 struct aml_dec_params *decParm = (struct aml_dec_params *)streamparm->parm.raw_data;
3684 const char *env;
zengliang.lic9f869d2023-02-15 08:32:32 +00003685 struct v4l2_ext_control control;
3686 struct v4l2_ext_controls ctrls;
3687 gboolean use_ext_config = FALSE;
3688 int major = 0,minor = 0;
3689 struct utsname info;
bo.xiao34e36202024-07-17 16:04:01 +08003690 gboolean is_interlaced = FALSE;
hanghang.luo2dfa0ac2024-07-09 11:33:39 +08003691 guint width, height;
bo.xiao34e36202024-07-17 16:04:01 +08003692
hanghang.luo7f403102024-07-04 10:33:01 +08003693 if (getenv("V4L2DEC_LOW_MEM_MODE"))
3694 v4l2object->low_memory_mode = TRUE;
3695 GST_DEBUG("low mem: %d",v4l2object->low_memory_mode);
bo.xiao34e36202024-07-17 16:04:01 +08003696
hanghang.luo2dfa0ac2024-07-09 11:33:39 +08003697 GstStructure *structure = gst_caps_get_structure(caps, 0);
3698 if (structure == NULL)
3699 {
3700 return;
3701 }
3702 gst_structure_get_uint(structure,"width",&width);
3703 gst_structure_get_uint(structure,"height",&height);
3704 if (gst_structure_has_field(structure, "interlace-mode"))
3705 {
bo.xiao34e36202024-07-17 16:04:01 +08003706 const gchar *mode = gst_structure_get_string(structure,"interlace-mode");
3707 is_interlaced = !strcmp(mode, "progressive") ? FALSE:TRUE;
hanghang.luo2dfa0ac2024-07-09 11:33:39 +08003708 GST_DEBUG("is_interlaced: %d",is_interlaced);
3709 }
hanghang.luo7f403102024-07-04 10:33:01 +08003710
xuesong.jiangae1548e2022-05-06 16:38:46 +08003711 if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT || v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
3712 {
fei.dengccc89632022-07-15 19:10:17 +08003713 /*set bit12 value to 1,
3714 *v4l2 output 0 pts of second interlace field frame */
hanghang.luo6a5bdff2024-04-15 06:29:43 +00003715 decParm->cfg.metadata_config_flag |= (1 << 12);
fei.deng7c3d67f2022-11-09 11:06:05 +08003716 decParm->parms_status = V4L2_CONFIG_PARM_DECODE_CFGINFO;
hanghang.luo6a5bdff2024-04-15 06:29:43 +00003717
3718 decParm->cfg.metadata_config_flag |= 1 << 13;
3719
3720 /*set bit18 value to 1
3721 *release vpp in advance */
3722 decParm->cfg.metadata_config_flag |= (1 << 18);
3723 decParm->cfg.low_latency_mode = v4l2object->low_latency_mode;
3724
zengliang.li8f538aa2024-06-25 17:31:20 +08003725 if (v4l2object->enable_nr)
3726 {
3727 GST_DEBUG("enable nr in di");
3728 decParm->cfg.metadata_config_flag |= (1 << 14);
3729 decParm->cfg.metadata_config_flag |= (1 << 15);
3730 }
3731
bo.xiao34e36202024-07-17 16:04:01 +08003732 decParm->cfg.double_write_mode = gst_aml_config_dw(v4l2object, pixFormat, width, height, is_interlaced);
hanghang.luo75664712024-07-01 19:28:10 +08003733 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "output cfg dw mode to %d", decParm->cfg.double_write_mode);
3734
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08003735 decParm->cfg.ref_buf_margin = GST_AML_V4L2_DEFAULT_CAP_BUF_MARGIN;
le.hancd3f2842024-06-26 09:37:50 +00003736 env = getenv("V4L2_SET_AMLOGIC_MARGIN_NUM");
3737 if (env)
3738 {
3739 decParm->cfg.ref_buf_margin = atoi(env);
3740 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "cfg margin to %d", decParm->cfg.ref_buf_margin);
3741 }
xuesong.jiangae1548e2022-05-06 16:38:46 +08003742
hanghang.luo6a5bdff2024-04-15 06:29:43 +00003743 // dv
3744 gboolean dv_bl_present_flag, dv_el_present_flag;
3745 int dvBaseLayerPresent = -1;
3746 int dvEnhancementLayerPresent = -1;
3747 /* have base and enhancement layers both, that means its dual layer,
3748 dv two layer flag will be true */
3749 if (gst_structure_get_boolean( structure, "dv_bl_present_flag", &dv_bl_present_flag))
3750 {
3751 dvBaseLayerPresent= dv_bl_present_flag?1:0;
3752 }
3753 if (gst_structure_get_boolean( structure, "dv_el_present_flag", &dv_el_present_flag))
3754 {
3755 dvEnhancementLayerPresent= dv_el_present_flag?1:0;
3756 }
3757
3758 /* have base and enhancement layers both, that means its dual layer, dv two layer flag will be true */
3759 if ( (dvBaseLayerPresent == 1) && (dvEnhancementLayerPresent == 1) )
3760 {
3761 decParm->cfg.metadata_config_flag |= (1 << 0);
3762 }
3763 else
3764 {
3765 decParm->cfg.metadata_config_flag |= (0 << 0);
3766 }
3767
3768 /* have one of then, it's standard dv stream, Non-standard dv flag will be false */
3769 if ( (dvBaseLayerPresent == 0) && (dvEnhancementLayerPresent == 0) )
3770 {
3771 decParm->cfg.metadata_config_flag |= (1 << 1);
3772 }
3773 else
3774 {
3775 decParm->cfg.metadata_config_flag |= (0 << 1);
3776 }
3777
3778 // HDR
xuesong.jiange1a19662022-06-21 20:30:22 +08003779 if ( gst_structure_has_field(structure, "colorimetry") )
3780 {
3781 const char *colorimetry= gst_structure_get_string(structure,"colorimetry");
3782 GstVideoColorimetry vci = {0};
3783 if ( colorimetry && gst_video_colorimetry_from_string( &vci, colorimetry ))
3784 {
3785 decParm->parms_status |= V4L2_CONFIG_PARM_DECODE_HDRINFO;
3786 decParm->hdr.signal_type= (1<<29); /* present flag */
3787 /*set default value, this is to keep up with driver hdr info synchronization*/
3788 decParm->hdr.signal_type |= (5<<26) | (1<<24);
3789
3790 gint hdrColorimetry[4] = {0};
3791 hdrColorimetry[0]= (int)vci.range;
3792 hdrColorimetry[1]= (int)vci.matrix;
3793 hdrColorimetry[2]= (int)vci.transfer;
3794 hdrColorimetry[3]= (int)vci.primaries;
3795 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "colorimetry: [%d,%d,%d,%d]",
3796 hdrColorimetry[0],
3797 hdrColorimetry[1],
3798 hdrColorimetry[2],
3799 hdrColorimetry[3] );
3800 /* range */
3801 switch ( hdrColorimetry[0] )
3802 {
le.han8d28eb82024-06-05 08:11:12 +00003803 case GST_VIDEO_COLOR_RANGE_0_255:
3804 case GST_VIDEO_COLOR_RANGE_16_235:
xuesong.jiange1a19662022-06-21 20:30:22 +08003805 decParm->hdr.signal_type |= ((hdrColorimetry[0] % 2)<<25);
3806 break;
3807 default:
3808 break;
3809 }
3810 /* matrix coefficient */
3811 switch ( hdrColorimetry[1] )
3812 {
le.han8d28eb82024-06-05 08:11:12 +00003813 case GST_VIDEO_COLOR_MATRIX_RGB: /* RGB */
xuesong.jiange1a19662022-06-21 20:30:22 +08003814 decParm->hdr.signal_type |= 0;
3815 break;
le.han8d28eb82024-06-05 08:11:12 +00003816 case GST_VIDEO_COLOR_MATRIX_FCC: /* FCC */
xuesong.jiange1a19662022-06-21 20:30:22 +08003817 decParm->hdr.signal_type |= 4;
3818 break;
le.han8d28eb82024-06-05 08:11:12 +00003819 case GST_VIDEO_COLOR_MATRIX_BT709: /* BT709 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003820 decParm->hdr.signal_type |= 1;
3821 break;
le.han8d28eb82024-06-05 08:11:12 +00003822 case GST_VIDEO_COLOR_MATRIX_BT601: /* BT601 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003823 decParm->hdr.signal_type |= 3;
3824 break;
le.han8d28eb82024-06-05 08:11:12 +00003825 case GST_VIDEO_COLOR_MATRIX_SMPTE240M: /* SMPTE240M */
xuesong.jiange1a19662022-06-21 20:30:22 +08003826 decParm->hdr.signal_type |= 7;
3827 break;
le.han8d28eb82024-06-05 08:11:12 +00003828 case GST_VIDEO_COLOR_MATRIX_BT2020: /* BT2020 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003829 decParm->hdr.signal_type |= 9;
3830 break;
3831 default: /* unknown */
3832 decParm->hdr.signal_type |= 2;
3833 break;
3834 }
3835 /* transfer function */
3836 switch ( hdrColorimetry[2] )
3837 {
le.han8d28eb82024-06-05 08:11:12 +00003838 case GST_VIDEO_TRANSFER_BT709: /* BT709 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003839 decParm->hdr.signal_type |= (1<<8);
3840 break;
le.han8d28eb82024-06-05 08:11:12 +00003841 case GST_VIDEO_TRANSFER_SMPTE240M: /* SMPTE240M */
xuesong.jiange1a19662022-06-21 20:30:22 +08003842 decParm->hdr.signal_type |= (7<<8);
3843 break;
le.han8d28eb82024-06-05 08:11:12 +00003844 case GST_VIDEO_TRANSFER_LOG100: /* LOG100 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003845 decParm->hdr.signal_type |= (9<<8);
3846 break;
le.han8d28eb82024-06-05 08:11:12 +00003847 case GST_VIDEO_TRANSFER_LOG316: /* LOG316 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003848 decParm->hdr.signal_type |= (10<<8);
3849 break;
le.han8d28eb82024-06-05 08:11:12 +00003850 case GST_VIDEO_TRANSFER_BT2020_12: /* BT2020_12 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003851 decParm->hdr.signal_type |= (15<<8);
3852 break;
le.han8d28eb82024-06-05 08:11:12 +00003853 case GST_VIDEO_TRANSFER_BT2020_10: /* BT2020_10 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003854 decParm->hdr.signal_type |= (14<<8);
3855 break;
le.han8d28eb82024-06-05 08:11:12 +00003856 #if ((GST_VERSION_MAJOR == 1) && (GST_VERSION_MINOR >= 18))
3857 case GST_VIDEO_TRANSFER_SMPTE2084: /* SMPTE2084 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003858 decParm->hdr.signal_type |= (16<<8);
3859 break;
le.han8d28eb82024-06-05 08:11:12 +00003860 #else
3861 case GST_VIDEO_TRANSFER_SMPTE_ST_2084: /* SMPTE2084 */
3862 decParm->hdr.signal_type |= (16<<8);
3863 break;
3864 #endif
3865 case GST_VIDEO_TRANSFER_ARIB_STD_B67: /* ARIB_STD_B67 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003866 decParm->hdr.signal_type |= (18<<8);
3867 break;
3868 #if ((GST_VERSION_MAJOR == 1) && (GST_VERSION_MINOR >= 18))
le.han8d28eb82024-06-05 08:11:12 +00003869 case GST_VIDEO_TRANSFER_BT601: /* BT601 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003870 decParm->hdr.signal_type |= (3<<8);
3871 break;
3872 #endif
le.han8d28eb82024-06-05 08:11:12 +00003873 case GST_VIDEO_TRANSFER_GAMMA10: /* GAMMA10 */
3874 case GST_VIDEO_TRANSFER_GAMMA18: /* GAMMA18 */
3875 case GST_VIDEO_TRANSFER_GAMMA20: /* GAMMA20 */
3876 case GST_VIDEO_TRANSFER_GAMMA22: /* GAMMA22 */
3877 case GST_VIDEO_TRANSFER_SRGB: /* SRGB */
3878 case GST_VIDEO_TRANSFER_GAMMA28: /* GAMMA28 */
3879 case GST_VIDEO_TRANSFER_ADOBERGB: /* ADOBERGB */
xuesong.jiange1a19662022-06-21 20:30:22 +08003880 default:
3881 break;
3882 }
3883 /* primaries */
3884 switch ( hdrColorimetry[3] )
3885 {
le.han8d28eb82024-06-05 08:11:12 +00003886 case GST_VIDEO_COLOR_PRIMARIES_BT709: /* BT709 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003887 decParm->hdr.signal_type |= ((1<<24)|(1<<16));
3888 break;
le.han8d28eb82024-06-05 08:11:12 +00003889 case GST_VIDEO_COLOR_PRIMARIES_BT470M: /* BT470M */
xuesong.jiange1a19662022-06-21 20:30:22 +08003890 decParm->hdr.signal_type |= ((1<<24)|(4<<16));
3891 break;
le.han8d28eb82024-06-05 08:11:12 +00003892 case GST_VIDEO_COLOR_PRIMARIES_BT470BG: /* BT470BG */
xuesong.jiange1a19662022-06-21 20:30:22 +08003893 decParm->hdr.signal_type |= ((1<<24)|(5<<16));
3894 break;
le.han8d28eb82024-06-05 08:11:12 +00003895 case GST_VIDEO_COLOR_PRIMARIES_SMPTE170M: /* SMPTE170M */
xuesong.jiange1a19662022-06-21 20:30:22 +08003896 decParm->hdr.signal_type |= ((1<<24)|(6<<16));
3897 break;
le.han8d28eb82024-06-05 08:11:12 +00003898 case GST_VIDEO_COLOR_PRIMARIES_SMPTE240M: /* SMPTE240M */
xuesong.jiange1a19662022-06-21 20:30:22 +08003899 decParm->hdr.signal_type |= ((1<<24)|(7<<16));
3900 break;
le.han8d28eb82024-06-05 08:11:12 +00003901 case GST_VIDEO_COLOR_PRIMARIES_FILM: /* FILM */
xuesong.jiange1a19662022-06-21 20:30:22 +08003902 decParm->hdr.signal_type |= ((1<<24)|(8<<16));
3903 break;
le.han8d28eb82024-06-05 08:11:12 +00003904 case GST_VIDEO_COLOR_PRIMARIES_BT2020: /* BT2020 */
xuesong.jiange1a19662022-06-21 20:30:22 +08003905 decParm->hdr.signal_type |= ((1<<24)|(9<<16));
3906 break;
le.han8d28eb82024-06-05 08:11:12 +00003907 case GST_VIDEO_COLOR_PRIMARIES_ADOBERGB: /* ADOBERGB */
xuesong.jiange1a19662022-06-21 20:30:22 +08003908 default:
3909 break;
3910 }
3911 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "HDR signal_type %X", decParm->hdr.signal_type);
3912 }
3913
3914 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "got caps %" GST_PTR_FORMAT, caps);
3915 GstStructure *st = gst_caps_get_structure(caps, 0);
3916 GstCapsFeatures *features = gst_caps_get_features(caps, 0);
3917
3918 if (gst_structure_has_field(st, "colorimetry"))
3919 {
3920 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "have colorimetry");
3921 }
3922
3923 if (st && features)
3924 {
3925 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "trace in remove colorimetry");
3926 gst_structure_remove_field(st, "colorimetry");
3927 gst_caps_features_remove(features, "colorimetry");
3928 }
3929 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "caps after remove colorimetry %" GST_PTR_FORMAT, caps);
3930 }
3931
le.han7d0af792024-06-05 08:44:18 +00003932 const char * field = NULL;
3933 if (gst_structure_has_field(structure, "mastering-display-metadata")) {
3934 field = "mastering-display-metadata";
3935 } else if (gst_structure_has_field(structure, "mastering-display-info")) {
3936 field = "mastering-display-info";
3937 }
3938
3939 if ( field )
xuesong.jiange1a19662022-06-21 20:30:22 +08003940 {
le.han7d0af792024-06-05 08:44:18 +00003941 const char *masteringDisplay= gst_structure_get_string(structure, field);
xuesong.jiange1a19662022-06-21 20:30:22 +08003942 float hdrMasteringDisplay[10];
3943 if ( masteringDisplay && sscanf( masteringDisplay, "%f:%f:%f:%f:%f:%f:%f:%f:%f:%f",
3944 &hdrMasteringDisplay[0],
3945 &hdrMasteringDisplay[1],
3946 &hdrMasteringDisplay[2],
3947 &hdrMasteringDisplay[3],
3948 &hdrMasteringDisplay[4],
3949 &hdrMasteringDisplay[5],
3950 &hdrMasteringDisplay[6],
3951 &hdrMasteringDisplay[7],
3952 &hdrMasteringDisplay[8],
3953 &hdrMasteringDisplay[9] ) == 10 )
3954 {
3955 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "mastering display [%f,%f,%f,%f,%f,%f,%f,%f,%f,%f]",
3956 hdrMasteringDisplay[0],
3957 hdrMasteringDisplay[1],
3958 hdrMasteringDisplay[2],
3959 hdrMasteringDisplay[3],
3960 hdrMasteringDisplay[4],
3961 hdrMasteringDisplay[5],
3962 hdrMasteringDisplay[6],
3963 hdrMasteringDisplay[7],
3964 hdrMasteringDisplay[8],
3965 hdrMasteringDisplay[9] );
3966
3967 decParm->hdr.color_parms.present_flag= 1;
3968 decParm->hdr.color_parms.primaries[2][0]= (uint32_t)(hdrMasteringDisplay[0]*50000); /* R.x */
3969 decParm->hdr.color_parms.primaries[2][1]= (uint32_t)(hdrMasteringDisplay[1]*50000); /* R.y */
3970 decParm->hdr.color_parms.primaries[0][0]= (uint32_t)(hdrMasteringDisplay[2]*50000); /* G.x */
3971 decParm->hdr.color_parms.primaries[0][1]= (uint32_t)(hdrMasteringDisplay[3]*50000); /* G.y */
3972 decParm->hdr.color_parms.primaries[1][0]= (uint32_t)(hdrMasteringDisplay[4]*50000); /* B.x */
3973 decParm->hdr.color_parms.primaries[1][1]= (uint32_t)(hdrMasteringDisplay[5]*50000); /* B.y */
3974 decParm->hdr.color_parms.white_point[0]= (uint32_t)(hdrMasteringDisplay[6]*50000);
3975 decParm->hdr.color_parms.white_point[1]= (uint32_t)(hdrMasteringDisplay[7]*50000);
3976 decParm->hdr.color_parms.luminance[0]= (uint32_t)(hdrMasteringDisplay[8]);
3977 decParm->hdr.color_parms.luminance[1]= (uint32_t)(hdrMasteringDisplay[9]);
3978 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "HDR mastering: primaries %X %X %X %X %X %X",
3979 decParm->hdr.color_parms.primaries[2][0],
3980 decParm->hdr.color_parms.primaries[2][1],
3981 decParm->hdr.color_parms.primaries[0][0],
3982 decParm->hdr.color_parms.primaries[0][1],
3983 decParm->hdr.color_parms.primaries[1][0],
3984 decParm->hdr.color_parms.primaries[1][1] );
3985 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "HDR mastering: white point: %X %X",
3986 decParm->hdr.color_parms.white_point[0],
3987 decParm->hdr.color_parms.white_point[1] );
3988 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "HDR mastering: luminance: %X %X",
3989 decParm->hdr.color_parms.luminance[0],
3990 decParm->hdr.color_parms.luminance[1] );
3991 }
3992
3993 GstStructure *st = gst_caps_get_structure(caps, 0);
3994 GstCapsFeatures * features = gst_caps_get_features(caps, 0);
3995 if (st && features)
3996 {
le.han7d0af792024-06-05 08:44:18 +00003997 gst_structure_remove_fields(st, field, NULL);
3998 gst_caps_features_remove(features, field);
xuesong.jiange1a19662022-06-21 20:30:22 +08003999 }
le.han7d0af792024-06-05 08:44:18 +00004000 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "caps after remove %s %" GST_PTR_FORMAT, field, caps);
xuesong.jiange1a19662022-06-21 20:30:22 +08004001 }
hanghang.luo6a5bdff2024-04-15 06:29:43 +00004002
4003 if (uname(&info) || sscanf(info.release, "%d.%d", &major, &minor) <= 0)
4004 {
4005 GST_DEBUG("get linux version failed");
4006 }
4007 GST_DEBUG("linux major version %d %d", major,minor);
4008
4009 use_ext_config = ((major == 5 && minor >= 15) || major >= 6) ? TRUE: FALSE;
4010
4011 if (use_ext_config)
4012 {
4013 memset(&ctrls, 0, sizeof(ctrls));
4014 memset(&control, 0, sizeof(control));
4015 control.id = AML_V4L2_DEC_PARMS_CONFIG;
4016 control.ptr = decParm;
4017 control.size = sizeof(struct aml_dec_params);
4018 ctrls.count = 1;
4019 ctrls.controls = &control;
4020 if (v4l2object->ioctl( v4l2object->video_fd, VIDIOC_S_EXT_CTRLS, &ctrls ) <0)
4021 {
hanghang.luo75664712024-07-01 19:28:10 +08004022 GST_ERROR_OBJECT(v4l2object->dbg_obj, "set vdec parm fail");
hanghang.luo6a5bdff2024-04-15 06:29:43 +00004023 }
4024 }
4025 else
4026 {
4027 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_S_PARM, streamparm) < 0)
4028 {
hanghang.luo75664712024-07-01 19:28:10 +08004029 GST_ERROR_OBJECT(v4l2object->dbg_obj, "set vdec parm fail");
hanghang.luo6a5bdff2024-04-15 06:29:43 +00004030 }
4031 }
4032 }
hanghang.luo75664712024-07-01 19:28:10 +08004033 else if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE || v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
hanghang.luo6a5bdff2024-04-15 06:29:43 +00004034 {
hanghang.luobfc63f82024-07-05 11:04:56 +08004035 struct aml_dec_params vdecParm;
hanghang.luo75664712024-07-01 19:28:10 +08004036 GstAmlV4l2VideoDec *self = (GstAmlV4l2VideoDec*) v4l2object->element;
hanghang.luobfc63f82024-07-05 11:04:56 +08004037 if (!get_amlogic_vdec_parm(v4l2object,&vdecParm))
4038 {
4039 GST_ERROR_OBJECT(v4l2object->dbg_obj, "can't get vdec parm");
4040 return;
4041 }
hanghang.luo75664712024-07-01 19:28:10 +08004042
bo.xiao34e36202024-07-17 16:04:01 +08004043 vdecParm.cfg.double_write_mode = gst_aml_config_dw(v4l2object, self->v4l2output->fmtdesc->pixelformat,
4044 width, height, is_interlaced);
hanghang.luobfc63f82024-07-05 11:04:56 +08004045 GST_DEBUG_OBJECT(v4l2object->dbg_obj, " capture cfg dw mode to %d", vdecParm.cfg.double_write_mode);
hanghang.luo75664712024-07-01 19:28:10 +08004046
4047 if (needSpecConfigForFg(v4l2object))
4048 {
bo.xiao34e36202024-07-17 16:04:01 +08004049 vdecParm.cfg.double_write_mode = VDEC_DW_MMU_1;
hanghang.luobfc63f82024-07-05 11:04:56 +08004050 GST_DEBUG_OBJECT(v4l2object->dbg_obj,"set fg dw mode %d", vdecParm.cfg.double_write_mode);
hanghang.luo75664712024-07-01 19:28:10 +08004051 }
4052
4053 if (uname(&info) || sscanf(info.release, "%d.%d", &major, &minor) <= 0)
4054 {
4055 GST_DEBUG("get linux version failed");
4056 }
4057 GST_DEBUG("linux major version %d %d", major,minor);
4058 use_ext_config = ((major == 5 && minor >= 15) || major >= 6) ? TRUE: FALSE;
4059 if (use_ext_config)
4060 {
4061 memset(&ctrls, 0, sizeof(ctrls));
4062 memset(&control, 0, sizeof(control));
4063 control.id = AML_V4L2_DEC_PARMS_CONFIG;
hanghang.luobfc63f82024-07-05 11:04:56 +08004064 control.ptr = &vdecParm;
hanghang.luo75664712024-07-01 19:28:10 +08004065 control.size = sizeof(struct aml_dec_params);
4066 ctrls.count = 1;
4067 ctrls.controls = &control;
4068 if (v4l2object->ioctl( v4l2object->video_fd, VIDIOC_S_EXT_CTRLS, &ctrls ) <0)
4069 {
4070 GST_ERROR_OBJECT(v4l2object->dbg_obj, "set vdec parm fail");
4071 }
4072 }
4073 else
4074 {
4075 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_S_PARM, streamparm) < 0)
4076 {
4077 GST_ERROR_OBJECT(v4l2object->dbg_obj, "set vdec parm fail");
4078 }
4079 }
hanghang.luo6a5bdff2024-04-15 06:29:43 +00004080 }
4081 else
4082 {
hanghang.luo75664712024-07-01 19:28:10 +08004083 GST_ERROR_OBJECT(v4l2object->dbg_obj,"can't deal with. please check buffer type.");
xuesong.jiangae1548e2022-05-06 16:38:46 +08004084 }
4085}
4086
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08004087static gint gst_aml_v4l2_object_get_dw_mode(GstAmlV4l2Object *v4l2object)
4088{
4089 struct v4l2_streamparm streamparm;
4090 struct aml_dec_params *decParm = (struct aml_dec_params *)(&streamparm.parm.raw_data);
4091 memset(&streamparm, 0x00, sizeof(struct v4l2_streamparm));
4092
4093 streamparm.type = V4L2_BUF_TYPE_VIDEO_OUTPUT;
4094 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_PARM, &streamparm) >= 0)
4095 {
4096 GST_DEBUG_OBJECT(v4l2object, "get dw mode:%d in type V4L2_BUF_TYPE_VIDEO_OUTPUT", decParm->cfg.double_write_mode);
4097 return decParm->cfg.double_write_mode;
4098 }
4099
4100 streamparm.type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
4101 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_PARM, &streamparm) >= 0)
4102 {
4103 GST_DEBUG_OBJECT(v4l2object, "get dw mode:%d in type V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE", decParm->cfg.double_write_mode);
4104 return decParm->cfg.double_write_mode;
4105 }
4106
4107 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");
4108 return -1;
4109}
4110
xuesong.jiangae1548e2022-05-06 16:38:46 +08004111static gboolean
4112gst_aml_v4l2_object_set_format_full(GstAmlV4l2Object *v4l2object, GstCaps *caps,
4113 gboolean try_only, GstAmlV4l2Error *error)
4114{
4115 gint fd = v4l2object->video_fd;
4116 struct v4l2_format format;
4117 struct v4l2_streamparm streamparm;
4118 enum v4l2_field field;
4119 guint32 pixelformat;
4120 struct v4l2_fmtdesc *fmtdesc;
4121 GstVideoInfo info;
4122 GstVideoAlignment align;
4123 gint width, height, fps_n, fps_d;
4124 gint n_v4l_planes;
4125 gint i = 0;
4126 gboolean is_mplane;
4127 enum v4l2_colorspace colorspace = 0;
4128 enum v4l2_quantization range = 0;
4129 enum v4l2_ycbcr_encoding matrix = 0;
4130 enum v4l2_xfer_func transfer = 0;
4131 GstStructure *s;
4132 gboolean disable_colorimetry = FALSE;
4133
4134 g_return_val_if_fail(!v4l2object->skip_try_fmt_probes ||
4135 gst_caps_is_writable(caps),
4136 FALSE);
4137
4138 GST_AML_V4L2_CHECK_OPEN(v4l2object);
4139 if (!try_only)
4140 GST_AML_V4L2_CHECK_NOT_ACTIVE(v4l2object);
4141
xuesong.jiangae1548e2022-05-06 16:38:46 +08004142 is_mplane = V4L2_TYPE_IS_MULTIPLANAR(v4l2object->type);
4143
4144 gst_video_info_init(&info);
4145 gst_video_alignment_reset(&align);
4146
4147 if (!gst_aml_v4l2_object_get_caps_info(v4l2object, caps, &fmtdesc, &info))
4148 goto invalid_caps;
4149
4150 pixelformat = fmtdesc->pixelformat;
4151 width = GST_VIDEO_INFO_WIDTH(&info);
4152 height = GST_VIDEO_INFO_HEIGHT(&info);
4153 fps_n = GST_VIDEO_INFO_FPS_N(&info);
4154 fps_d = GST_VIDEO_INFO_FPS_D(&info);
4155
hanghang.luo9edfc7d2023-05-17 07:01:05 +00004156 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "Check image size");
4157 struct v4l2_frmsizeenum size;
4158 memset (&size, 0, sizeof (struct v4l2_frmsizeenum));
4159 size.index = 0;
4160 size.pixel_format = pixelformat;
4161 if (v4l2object->ioctl (fd, VIDIOC_ENUM_FRAMESIZES, &size) < 0)
4162 return FALSE;
4163 if (size.type == V4L2_FRMSIZE_TYPE_STEPWISE)
4164 {
4165 guint32 maxw, maxh;
4166 maxw = MIN (size.stepwise.max_width, G_MAXINT);
4167 maxh = MIN (size.stepwise.max_height, G_MAXINT);
4168 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "image from caps w_h:%d_%d", width, height);
4169 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "v4l2 support max w_h:%d_%d", maxw, maxh);
4170 if (width*height > maxw*maxh)
4171 return FALSE;
4172 GST_DEBUG_OBJECT (v4l2object->dbg_obj, "Check image size ok");
4173 }
4174
fei.deng7c3d67f2022-11-09 11:06:05 +08004175 //set amlogic params here,because we need pix format to set dw mode
4176 memset(&streamparm, 0x00, sizeof(struct v4l2_streamparm));
4177 streamparm.type = v4l2object->type;
4178 set_amlogic_vdec_parm(v4l2object, &streamparm, caps, pixelformat);
4179
xuesong.jiangae1548e2022-05-06 16:38:46 +08004180 /* if encoded format (GST_VIDEO_INFO_N_PLANES return 0)
4181 * or if contiguous is prefered */
4182 n_v4l_planes = GST_VIDEO_INFO_N_PLANES(&info);
4183 if (!n_v4l_planes || !v4l2object->prefered_non_contiguous)
4184 n_v4l_planes = 1;
4185
4186 if (GST_VIDEO_INFO_IS_INTERLACED(&info))
4187 {
4188 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "interlaced video");
4189 /* ideally we would differentiate between types of interlaced video
4190 * but there is not sufficient information in the caps..
4191 */
4192 field = V4L2_FIELD_INTERLACED;
4193 }
4194 else
4195 {
4196 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "progressive video");
4197 field = V4L2_FIELD_NONE;
4198 }
4199
4200 /* We first pick the main colorspace from the primaries */
4201 switch (info.colorimetry.primaries)
4202 {
4203 case GST_VIDEO_COLOR_PRIMARIES_BT709:
4204 /* There is two colorspaces using these primaries, use the range to
4205 * differentiate */
4206 if (info.colorimetry.range == GST_VIDEO_COLOR_RANGE_16_235)
4207 colorspace = V4L2_COLORSPACE_REC709;
4208 else
4209 colorspace = V4L2_COLORSPACE_SRGB;
4210 break;
4211 case GST_VIDEO_COLOR_PRIMARIES_BT2020:
4212 colorspace = V4L2_COLORSPACE_BT2020;
4213 break;
4214 case GST_VIDEO_COLOR_PRIMARIES_BT470M:
4215 colorspace = V4L2_COLORSPACE_470_SYSTEM_M;
4216 break;
4217 case GST_VIDEO_COLOR_PRIMARIES_BT470BG:
4218 colorspace = V4L2_COLORSPACE_470_SYSTEM_BG;
4219 break;
4220 case GST_VIDEO_COLOR_PRIMARIES_SMPTE170M:
4221 colorspace = V4L2_COLORSPACE_SMPTE170M;
4222 break;
4223 case GST_VIDEO_COLOR_PRIMARIES_SMPTE240M:
4224 colorspace = V4L2_COLORSPACE_SMPTE240M;
4225 break;
4226
4227 case GST_VIDEO_COLOR_PRIMARIES_FILM:
4228 case GST_VIDEO_COLOR_PRIMARIES_UNKNOWN:
4229 /* We don't know, we will guess */
4230 break;
4231
4232 default:
4233 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4234 "Unknown colorimetry primaries %d", info.colorimetry.primaries);
4235 break;
4236 }
4237
4238 switch (info.colorimetry.range)
4239 {
4240 case GST_VIDEO_COLOR_RANGE_0_255:
4241 range = V4L2_QUANTIZATION_FULL_RANGE;
4242 break;
4243 case GST_VIDEO_COLOR_RANGE_16_235:
4244 range = V4L2_QUANTIZATION_LIM_RANGE;
4245 break;
4246 case GST_VIDEO_COLOR_RANGE_UNKNOWN:
4247 /* We let the driver pick a default one */
4248 break;
4249 default:
4250 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4251 "Unknown colorimetry range %d", info.colorimetry.range);
4252 break;
4253 }
4254
4255 switch (info.colorimetry.matrix)
4256 {
4257 case GST_VIDEO_COLOR_MATRIX_RGB:
4258 /* Unspecified, leave to default */
4259 break;
4260 /* FCC is about the same as BT601 with less digit */
4261 case GST_VIDEO_COLOR_MATRIX_FCC:
4262 case GST_VIDEO_COLOR_MATRIX_BT601:
4263 matrix = V4L2_YCBCR_ENC_601;
4264 break;
4265 case GST_VIDEO_COLOR_MATRIX_BT709:
4266 matrix = V4L2_YCBCR_ENC_709;
4267 break;
4268 case GST_VIDEO_COLOR_MATRIX_SMPTE240M:
4269 matrix = V4L2_YCBCR_ENC_SMPTE240M;
4270 break;
4271 case GST_VIDEO_COLOR_MATRIX_BT2020:
4272 matrix = V4L2_YCBCR_ENC_BT2020;
4273 break;
4274 case GST_VIDEO_COLOR_MATRIX_UNKNOWN:
4275 /* We let the driver pick a default one */
4276 break;
4277 default:
4278 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4279 "Unknown colorimetry matrix %d", info.colorimetry.matrix);
4280 break;
4281 }
4282
4283 switch (info.colorimetry.transfer)
4284 {
4285 case GST_VIDEO_TRANSFER_GAMMA18:
4286 case GST_VIDEO_TRANSFER_GAMMA20:
4287 case GST_VIDEO_TRANSFER_GAMMA22:
4288 case GST_VIDEO_TRANSFER_GAMMA28:
4289 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4290 "GAMMA 18, 20, 22, 28 transfer functions not supported");
4291 /* fallthrough */
4292 case GST_VIDEO_TRANSFER_GAMMA10:
4293 transfer = V4L2_XFER_FUNC_NONE;
4294 break;
4295 case GST_VIDEO_TRANSFER_BT2020_12:
4296 case GST_VIDEO_TRANSFER_BT709:
4297 transfer = V4L2_XFER_FUNC_709;
4298 break;
4299 case GST_VIDEO_TRANSFER_SMPTE240M:
4300 transfer = V4L2_XFER_FUNC_SMPTE240M;
4301 break;
4302 case GST_VIDEO_TRANSFER_SRGB:
4303 transfer = V4L2_XFER_FUNC_SRGB;
4304 break;
4305 case GST_VIDEO_TRANSFER_LOG100:
4306 case GST_VIDEO_TRANSFER_LOG316:
4307 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4308 "LOG 100, 316 transfer functions not supported");
4309 /* FIXME No known sensible default, maybe AdobeRGB ? */
4310 break;
4311 case GST_VIDEO_TRANSFER_UNKNOWN:
4312 /* We let the driver pick a default one */
4313 break;
4314 default:
4315 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4316 "Unknown colorimetry tranfer %d", info.colorimetry.transfer);
4317 break;
4318 }
4319
4320 if (colorspace == 0)
4321 {
4322 /* Try to guess colorspace according to pixelformat and size */
4323 if (GST_VIDEO_INFO_IS_YUV(&info))
4324 {
4325 if (range == V4L2_QUANTIZATION_FULL_RANGE && matrix == V4L2_YCBCR_ENC_601 && transfer == 0)
4326 {
4327 /* Full range BT.601 YCbCr encoding with unknown primaries and transfer
4328 * function most likely is JPEG */
4329 colorspace = V4L2_COLORSPACE_JPEG;
4330 transfer = V4L2_XFER_FUNC_SRGB;
4331 }
4332 else
4333 {
4334 /* SD streams likely use SMPTE170M and HD streams REC709 */
4335 if (width <= 720 && height <= 576)
4336 colorspace = V4L2_COLORSPACE_SMPTE170M;
4337 else
4338 colorspace = V4L2_COLORSPACE_REC709;
4339 }
4340 }
4341 else if (GST_VIDEO_INFO_IS_RGB(&info))
4342 {
4343 colorspace = V4L2_COLORSPACE_SRGB;
4344 transfer = V4L2_XFER_FUNC_NONE;
4345 }
4346 }
4347
4348 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Desired format %dx%d, format "
4349 "%" GST_FOURCC_FORMAT " stride: %d",
4350 width, height,
4351 GST_FOURCC_ARGS(pixelformat), GST_VIDEO_INFO_PLANE_STRIDE(&info, 0));
4352
4353 memset(&format, 0x00, sizeof(struct v4l2_format));
4354 format.type = v4l2object->type;
4355
4356 if (is_mplane)
4357 {
4358 format.type = v4l2object->type;
4359 format.fmt.pix_mp.pixelformat = pixelformat;
4360 format.fmt.pix_mp.width = width;
4361 format.fmt.pix_mp.height = height;
4362 format.fmt.pix_mp.field = field;
4363 format.fmt.pix_mp.num_planes = n_v4l_planes;
4364
4365 /* try to ask our prefered stride but it's not a failure if not
4366 * accepted */
4367 for (i = 0; i < n_v4l_planes; i++)
4368 {
4369 gint stride = GST_VIDEO_INFO_PLANE_STRIDE(&info, i);
4370
4371 if (GST_VIDEO_FORMAT_INFO_IS_TILED(info.finfo))
4372 stride = GST_VIDEO_TILE_X_TILES(stride) << GST_VIDEO_FORMAT_INFO_TILE_WS(info.finfo);
4373
4374 format.fmt.pix_mp.plane_fmt[i].bytesperline = stride;
4375 }
4376
4377 if (GST_VIDEO_INFO_FORMAT(&info) == GST_VIDEO_FORMAT_ENCODED)
4378 {
4379 if (v4l2object->req_mode == GST_V4L2_IO_DMABUF_IMPORT)
4380 format.fmt.pix_mp.plane_fmt[0].sizeimage = 1;
4381 else
hanghang.luo75664712024-07-01 19:28:10 +08004382 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 +08004383 }
4384 }
4385 else
4386 {
4387 gint stride = GST_VIDEO_INFO_PLANE_STRIDE(&info, 0);
4388
4389 format.type = v4l2object->type;
4390
4391 format.fmt.pix.width = width;
4392 format.fmt.pix.height = height;
4393 format.fmt.pix.pixelformat = pixelformat;
4394 format.fmt.pix.field = field;
4395
4396 if (GST_VIDEO_FORMAT_INFO_IS_TILED(info.finfo))
4397 stride = GST_VIDEO_TILE_X_TILES(stride) << GST_VIDEO_FORMAT_INFO_TILE_WS(info.finfo);
4398
4399 /* try to ask our prefered stride */
4400 format.fmt.pix.bytesperline = stride;
4401
4402 if (GST_VIDEO_INFO_FORMAT(&info) == GST_VIDEO_FORMAT_ENCODED)
4403 {
4404 if (v4l2object->req_mode == GST_V4L2_IO_DMABUF_IMPORT)
4405 format.fmt.pix_mp.plane_fmt[0].sizeimage = 1;
4406 else
hanghang.luo75664712024-07-01 19:28:10 +08004407 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 +08004408 }
4409 }
4410
4411 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Desired format is %dx%d, format "
4412 "%" GST_FOURCC_FORMAT ", nb planes %d",
4413 format.fmt.pix.width,
4414 format.fmt.pix_mp.height,
4415 GST_FOURCC_ARGS(format.fmt.pix.pixelformat),
4416 is_mplane ? format.fmt.pix_mp.num_planes : 1);
4417
4418#ifndef GST_DISABLE_GST_DEBUG
4419 if (is_mplane)
4420 {
4421 for (i = 0; i < format.fmt.pix_mp.num_planes; i++)
4422 GST_DEBUG_OBJECT(v4l2object->dbg_obj, " stride %d",
4423 format.fmt.pix_mp.plane_fmt[i].bytesperline);
4424 }
4425 else
4426 {
4427 GST_DEBUG_OBJECT(v4l2object->dbg_obj, " stride %d",
4428 format.fmt.pix.bytesperline);
4429 }
4430#endif
4431
4432 if (is_mplane)
4433 {
4434 format.fmt.pix_mp.colorspace = colorspace;
4435 format.fmt.pix_mp.quantization = range;
4436 format.fmt.pix_mp.ycbcr_enc = matrix;
4437 format.fmt.pix_mp.xfer_func = transfer;
4438 }
4439 else
4440 {
4441 format.fmt.pix.priv = V4L2_PIX_FMT_PRIV_MAGIC;
4442 format.fmt.pix.colorspace = colorspace;
4443 format.fmt.pix.quantization = range;
4444 format.fmt.pix.ycbcr_enc = matrix;
4445 format.fmt.pix.xfer_func = transfer;
4446 }
4447
4448 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Desired colorspace is %d:%d:%d:%d",
4449 colorspace, range, matrix, transfer);
4450
4451 if (try_only)
4452 {
4453 if (v4l2object->ioctl(fd, VIDIOC_TRY_FMT, &format) < 0)
4454 goto try_fmt_failed;
4455 }
4456 else
4457 {
4458 if (v4l2object->ioctl(fd, VIDIOC_S_FMT, &format) < 0)
4459 goto set_fmt_failed;
4460 }
4461
4462 if (is_mplane)
4463 {
4464 colorspace = format.fmt.pix_mp.colorspace;
4465 range = format.fmt.pix_mp.quantization;
4466 matrix = format.fmt.pix_mp.ycbcr_enc;
4467 transfer = format.fmt.pix_mp.xfer_func;
4468 }
4469 else
4470 {
4471 colorspace = format.fmt.pix.colorspace;
4472 range = format.fmt.pix.quantization;
4473 matrix = format.fmt.pix.ycbcr_enc;
4474 transfer = format.fmt.pix.xfer_func;
4475 }
4476
4477 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Got format of %dx%d, format "
4478 "%" GST_FOURCC_FORMAT ", nb planes %d, colorspace %d:%d:%d:%d",
4479 format.fmt.pix.width, format.fmt.pix_mp.height,
4480 GST_FOURCC_ARGS(format.fmt.pix.pixelformat),
4481 is_mplane ? format.fmt.pix_mp.num_planes : 1,
4482 colorspace, range, matrix, transfer);
4483
4484#ifndef GST_DISABLE_GST_DEBUG
4485 if (is_mplane)
4486 {
4487 for (i = 0; i < format.fmt.pix_mp.num_planes; i++)
4488 GST_DEBUG_OBJECT(v4l2object->dbg_obj, " stride %d, sizeimage %d",
4489 format.fmt.pix_mp.plane_fmt[i].bytesperline,
4490 format.fmt.pix_mp.plane_fmt[i].sizeimage);
4491 }
4492 else
4493 {
4494 GST_DEBUG_OBJECT(v4l2object->dbg_obj, " stride %d, sizeimage %d",
4495 format.fmt.pix.bytesperline, format.fmt.pix.sizeimage);
4496 }
4497#endif
4498
4499 if (format.fmt.pix.pixelformat != pixelformat)
4500 goto invalid_pixelformat;
4501
4502 /* Only negotiate size with raw data.
4503 * For some codecs the dimensions are *not* in the bitstream, IIRC VC1
4504 * in ASF mode for example, there is also not reason for a driver to
4505 * change the size. */
4506 if (info.finfo->format != GST_VIDEO_FORMAT_ENCODED)
4507 {
4508 /* We can crop larger images */
4509 if (format.fmt.pix.width < width || format.fmt.pix.height < height)
4510 goto invalid_dimensions;
4511
4512 /* Note, this will be adjusted if upstream has non-centered cropping. */
4513 align.padding_top = 0;
4514 align.padding_bottom = format.fmt.pix.height - height;
4515 align.padding_left = 0;
4516 align.padding_right = format.fmt.pix.width - width;
4517 }
4518
4519 if (is_mplane && format.fmt.pix_mp.num_planes != n_v4l_planes)
4520 goto invalid_planes;
4521
4522 /* used to check colorimetry and interlace mode fields presence */
4523 s = gst_caps_get_structure(caps, 0);
4524
4525 if (!gst_aml_v4l2_object_get_interlace_mode(format.fmt.pix.field,
4526 &info.interlace_mode))
4527 goto invalid_field;
4528 if (gst_structure_has_field(s, "interlace-mode"))
4529 {
4530 if (format.fmt.pix.field != field)
4531 goto invalid_field;
4532 }
4533
4534 if (gst_aml_v4l2_object_get_colorspace(&format, &info.colorimetry))
4535 {
4536 if (gst_structure_has_field(s, "colorimetry"))
4537 {
xuesong.jiange1a19662022-06-21 20:30:22 +08004538 if (!gst_aml_v4l2_video_colorimetry_matches(&info.colorimetry, gst_structure_get_string(s, "colorimetry")))
4539 {
4540 // goto invalid_colorimetry;
4541 }
xuesong.jiangae1548e2022-05-06 16:38:46 +08004542 }
4543 }
4544 else
4545 {
4546 /* The driver (or libv4l2) is miss-behaving, just ignore colorimetry from
4547 * the TRY_FMT */
4548 disable_colorimetry = TRUE;
4549 if (gst_structure_has_field(s, "colorimetry"))
4550 gst_structure_remove_field(s, "colorimetry");
4551 }
4552
4553 /* In case we have skipped the try_fmt probes, we'll need to set the
4554 * colorimetry and interlace-mode back into the caps. */
4555 if (v4l2object->skip_try_fmt_probes)
4556 {
4557 if (!disable_colorimetry && !gst_structure_has_field(s, "colorimetry"))
4558 {
4559 gchar *str = gst_video_colorimetry_to_string(&info.colorimetry);
4560 gst_structure_set(s, "colorimetry", G_TYPE_STRING, str, NULL);
4561 g_free(str);
4562 }
4563
4564 if (!gst_structure_has_field(s, "interlace-mode"))
4565 gst_structure_set(s, "interlace-mode", G_TYPE_STRING,
4566 gst_video_interlace_mode_to_string(info.interlace_mode), NULL);
4567 }
4568
4569 if (try_only) /* good enough for trying only */
4570 return TRUE;
4571
4572 if (GST_VIDEO_INFO_HAS_ALPHA(&info))
4573 {
4574 struct v4l2_control ctl = {
4575 0,
4576 };
4577 ctl.id = V4L2_CID_ALPHA_COMPONENT;
4578 ctl.value = 0xff;
4579
4580 if (v4l2object->ioctl(fd, VIDIOC_S_CTRL, &ctl) < 0)
4581 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4582 "Failed to set alpha component value");
4583 }
4584
4585 /* Is there a reason we require the caller to always specify a framerate? */
4586 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Desired framerate: %u/%u", fps_n,
4587 fps_d);
4588
4589 if (v4l2object->ioctl(fd, VIDIOC_G_PARM, &streamparm) < 0)
4590 goto get_parm_failed;
4591
4592 if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE || v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
4593 {
4594 GST_VIDEO_INFO_FPS_N(&info) =
4595 streamparm.parm.capture.timeperframe.denominator;
4596 GST_VIDEO_INFO_FPS_D(&info) =
4597 streamparm.parm.capture.timeperframe.numerator;
4598
4599 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Got capture framerate: %u/%u",
4600 streamparm.parm.capture.timeperframe.denominator,
4601 streamparm.parm.capture.timeperframe.numerator);
4602
4603 /* We used to skip frame rate setup if the camera was already setup
4604 * with the requested frame rate. This breaks some cameras though,
4605 * causing them to not output data (several models of Thinkpad cameras
4606 * have this problem at least).
4607 * So, don't skip. */
4608 GST_LOG_OBJECT(v4l2object->dbg_obj, "Setting capture framerate to %u/%u",
4609 fps_n, fps_d);
4610 /* We want to change the frame rate, so check whether we can. Some cheap USB
4611 * cameras don't have the capability */
4612 if ((streamparm.parm.capture.capability & V4L2_CAP_TIMEPERFRAME) == 0)
4613 {
4614 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
4615 "Not setting capture framerate (not supported)");
4616 goto done;
4617 }
4618
4619 /* Note: V4L2 wants the frame interval, we have the frame rate */
4620 streamparm.parm.capture.timeperframe.numerator = fps_d;
4621 streamparm.parm.capture.timeperframe.denominator = fps_n;
4622
zengliang.lic9f869d2023-02-15 08:32:32 +00004623 /* Amlogic sets parameters to the decoder and only supports delivery of private structures */
4624 //some cheap USB cam's won't accept any change */
4625 //if (v4l2object->ioctl(fd, VIDIOC_S_PARM, &streamparm) < 0)
4626 //goto set_parm_failed;
xuesong.jiangae1548e2022-05-06 16:38:46 +08004627
4628 if (streamparm.parm.capture.timeperframe.numerator > 0 &&
4629 streamparm.parm.capture.timeperframe.denominator > 0)
4630 {
4631 /* get new values */
4632 fps_d = streamparm.parm.capture.timeperframe.numerator;
4633 fps_n = streamparm.parm.capture.timeperframe.denominator;
4634
4635 GST_INFO_OBJECT(v4l2object->dbg_obj, "Set capture framerate to %u/%u",
4636 fps_n, fps_d);
4637 }
4638 else
4639 {
4640 /* fix v4l2 capture driver to provide framerate values */
4641 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4642 "Reuse caps framerate %u/%u - fix v4l2 capture driver", fps_n, fps_d);
4643 }
4644
4645 GST_VIDEO_INFO_FPS_N(&info) = fps_n;
4646 GST_VIDEO_INFO_FPS_D(&info) = fps_d;
4647 }
4648 else if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT || v4l2object->type == V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE)
4649 {
4650 GST_VIDEO_INFO_FPS_N(&info) =
4651 streamparm.parm.output.timeperframe.denominator;
4652 GST_VIDEO_INFO_FPS_D(&info) =
4653 streamparm.parm.output.timeperframe.numerator;
4654
4655 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Got output framerate: %u/%u",
4656 streamparm.parm.output.timeperframe.denominator,
4657 streamparm.parm.output.timeperframe.numerator);
4658
4659 GST_LOG_OBJECT(v4l2object->dbg_obj, "Setting output framerate to %u/%u",
4660 fps_n, fps_d);
4661 if ((streamparm.parm.output.capability & V4L2_CAP_TIMEPERFRAME) == 0)
4662 {
4663 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
4664 "Not setting output framerate (not supported)");
4665 goto done;
4666 }
4667
4668 /* Note: V4L2 wants the frame interval, we have the frame rate */
4669 streamparm.parm.output.timeperframe.numerator = fps_d;
4670 streamparm.parm.output.timeperframe.denominator = fps_n;
4671
zengliang.lic9f869d2023-02-15 08:32:32 +00004672 /*Amlogic sets parameters to the decoder and only supports delivery of private structures*/
4673 //if (v4l2object->ioctl(fd, VIDIOC_S_PARM, &streamparm) < 0)
4674 //goto set_parm_failed;
xuesong.jiangae1548e2022-05-06 16:38:46 +08004675
4676 if (streamparm.parm.output.timeperframe.numerator > 0 &&
4677 streamparm.parm.output.timeperframe.denominator > 0)
4678 {
4679 /* get new values */
4680 fps_d = streamparm.parm.output.timeperframe.numerator;
4681 fps_n = streamparm.parm.output.timeperframe.denominator;
4682
4683 GST_INFO_OBJECT(v4l2object->dbg_obj, "Set output framerate to %u/%u",
4684 fps_n, fps_d);
4685 }
4686 else
4687 {
4688 /* fix v4l2 output driver to provide framerate values */
4689 GST_WARNING_OBJECT(v4l2object->dbg_obj,
4690 "Reuse caps framerate %u/%u - fix v4l2 output driver", fps_n, fps_d);
4691 }
4692
4693 GST_VIDEO_INFO_FPS_N(&info) = fps_n;
4694 GST_VIDEO_INFO_FPS_D(&info) = fps_d;
4695 }
4696
4697done:
4698 /* add boolean return, so we can fail on drivers bugs */
4699 gst_aml_v4l2_object_save_format(v4l2object, fmtdesc, &format, &info, &align);
4700
4701 /* now configure the pool */
4702 if (!gst_aml_v4l2_object_setup_pool(v4l2object, caps))
4703 goto pool_failed;
4704
4705 return TRUE;
4706
4707 /* ERRORS */
4708invalid_caps:
4709{
4710 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "can't parse caps %" GST_PTR_FORMAT,
4711 caps);
4712
4713 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4714 (_("Invalid caps")), ("Can't parse caps %" GST_PTR_FORMAT, caps));
4715 return FALSE;
4716}
4717try_fmt_failed:
4718{
4719 if (errno == EINVAL)
4720 {
4721 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4722 (_("Device '%s' has no supported format"), v4l2object->videodev),
4723 ("Call to TRY_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4724 GST_FOURCC_ARGS(pixelformat), width, height,
4725 g_strerror(errno)));
4726 }
4727 else
4728 {
4729 GST_AML_V4L2_ERROR(error, RESOURCE, FAILED,
4730 (_("Device '%s' failed during initialization"),
4731 v4l2object->videodev),
4732 ("Call to TRY_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4733 GST_FOURCC_ARGS(pixelformat), width, height,
4734 g_strerror(errno)));
4735 }
4736 return FALSE;
4737}
4738set_fmt_failed:
4739{
4740 if (errno == EBUSY)
4741 {
4742 GST_AML_V4L2_ERROR(error, RESOURCE, BUSY,
4743 (_("Device '%s' is busy"), v4l2object->videodev),
4744 ("Call to S_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4745 GST_FOURCC_ARGS(pixelformat), width, height,
4746 g_strerror(errno)));
4747 }
4748 else if (errno == EINVAL)
4749 {
4750 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4751 (_("Device '%s' has no supported format"), v4l2object->videodev),
4752 ("Call to S_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4753 GST_FOURCC_ARGS(pixelformat), width, height,
4754 g_strerror(errno)));
4755 }
4756 else
4757 {
4758 GST_AML_V4L2_ERROR(error, RESOURCE, FAILED,
4759 (_("Device '%s' failed during initialization"),
4760 v4l2object->videodev),
4761 ("Call to S_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
4762 GST_FOURCC_ARGS(pixelformat), width, height,
4763 g_strerror(errno)));
4764 }
4765 return FALSE;
4766}
4767invalid_dimensions:
4768{
4769 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4770 (_("Device '%s' cannot capture at %dx%d"),
4771 v4l2object->videodev, width, height),
4772 ("Tried to capture at %dx%d, but device returned size %dx%d",
4773 width, height, format.fmt.pix.width, format.fmt.pix.height));
4774 return FALSE;
4775}
4776invalid_pixelformat:
4777{
4778 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4779 (_("Device '%s' cannot capture in the specified format"),
4780 v4l2object->videodev),
4781 ("Tried to capture in %" GST_FOURCC_FORMAT
4782 ", but device returned format"
4783 " %" GST_FOURCC_FORMAT,
4784 GST_FOURCC_ARGS(pixelformat),
4785 GST_FOURCC_ARGS(format.fmt.pix.pixelformat)));
4786 return FALSE;
4787}
4788invalid_planes:
4789{
4790 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4791 (_("Device '%s' does support non-contiguous planes"),
4792 v4l2object->videodev),
4793 ("Device wants %d planes", format.fmt.pix_mp.num_planes));
4794 return FALSE;
4795}
4796invalid_field:
4797{
4798 enum v4l2_field wanted_field;
4799
4800 if (is_mplane)
4801 wanted_field = format.fmt.pix_mp.field;
4802 else
4803 wanted_field = format.fmt.pix.field;
4804
4805 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4806 (_("Device '%s' does not support %s interlacing"),
4807 v4l2object->videodev,
4808 field == V4L2_FIELD_NONE ? "progressive" : "interleaved"),
4809 ("Device wants %s interlacing",
4810 wanted_field == V4L2_FIELD_NONE ? "progressive" : "interleaved"));
4811 return FALSE;
4812}
hanghang.luo3128f102022-08-18 10:36:19 +08004813#ifdef DELETE_FOR_LGE
xuesong.jiangae1548e2022-05-06 16:38:46 +08004814invalid_colorimetry:
4815{
4816 gchar *wanted_colorimetry;
4817
4818 wanted_colorimetry = gst_video_colorimetry_to_string(&info.colorimetry);
4819
4820 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4821 (_("Device '%s' does not support %s colorimetry"),
4822 v4l2object->videodev, gst_structure_get_string(s, "colorimetry")),
4823 ("Device wants %s colorimetry", wanted_colorimetry));
4824
4825 g_free(wanted_colorimetry);
4826 return FALSE;
4827}
hanghang.luo3128f102022-08-18 10:36:19 +08004828#endif
xuesong.jiangae1548e2022-05-06 16:38:46 +08004829get_parm_failed:
4830{
4831 /* it's possible that this call is not supported */
4832 if (errno != EINVAL && errno != ENOTTY)
4833 {
4834 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4835 (_("Could not get parameters on device '%s'"),
4836 v4l2object->videodev),
4837 GST_ERROR_SYSTEM);
4838 }
4839 goto done;
4840}
4841set_parm_failed:
4842{
4843 GST_AML_V4L2_ERROR(error, RESOURCE, SETTINGS,
4844 (_("Video device did not accept new frame rate setting.")),
4845 GST_ERROR_SYSTEM);
4846 goto done;
4847}
4848pool_failed:
4849{
4850 /* setup_pool already send the error */
4851 return FALSE;
4852}
4853}
4854
4855gboolean
4856gst_aml_v4l2_object_set_format(GstAmlV4l2Object *v4l2object, GstCaps *caps,
4857 GstAmlV4l2Error *error)
4858{
4859 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Setting format to %" GST_PTR_FORMAT,
4860 caps);
4861 return gst_aml_v4l2_object_set_format_full(v4l2object, caps, FALSE, error);
4862}
4863
4864gboolean
4865gst_aml_v4l2_object_try_format(GstAmlV4l2Object *v4l2object, GstCaps *caps,
4866 GstAmlV4l2Error *error)
4867{
4868 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "Trying format %" GST_PTR_FORMAT,
4869 caps);
4870 return gst_aml_v4l2_object_set_format_full(v4l2object, caps, TRUE, error);
4871}
4872
4873GstFlowReturn
4874gst_aml_v4l2_object_poll(GstAmlV4l2Object *v4l2object)
4875{
4876 gint ret;
4877
4878 if (!v4l2object->can_poll_device)
4879 goto done;
4880
4881 GST_LOG_OBJECT(v4l2object, "polling device");
4882
4883again:
4884 ret = gst_poll_wait(v4l2object->poll, GST_CLOCK_TIME_NONE);
4885 if (G_UNLIKELY(ret < 0))
4886 {
4887 switch (errno)
4888 {
4889 case EBUSY:
4890 goto stopped;
4891 case EAGAIN:
4892 case EINTR:
4893 goto again;
4894 case ENXIO:
4895 GST_WARNING_OBJECT(v4l2object,
4896 "v4l2 device doesn't support polling. Disabling"
4897 " using libv4l2 in this case may cause deadlocks");
4898 v4l2object->can_poll_device = FALSE;
4899 goto done;
4900 default:
4901 goto select_error;
4902 }
4903 }
4904
4905done:
4906 return GST_FLOW_OK;
4907
4908 /* ERRORS */
4909stopped:
4910{
4911 GST_DEBUG_OBJECT(v4l2object, "stop called");
4912 return GST_FLOW_FLUSHING;
4913}
4914select_error:
4915{
4916 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, READ, (NULL),
4917 ("poll error %d: %s (%d)", ret, g_strerror(errno), errno));
4918 return GST_FLOW_ERROR;
4919}
4920}
4921
4922GstFlowReturn
4923gst_aml_v4l2_object_dqevent(GstAmlV4l2Object *v4l2object)
4924{
4925 GstFlowReturn res;
4926 struct v4l2_event evt;
4927
4928 if ((res = gst_aml_v4l2_object_poll(v4l2object)) != GST_FLOW_OK)
4929 goto poll_failed;
4930
fei.deng678f7052024-07-10 20:11:26 +08004931 //only read v4l2 pri event
4932 if (!gst_poll_fd_can_read_pri(v4l2object->poll, &v4l2object->pollfd))
4933 {
4934 GST_DEBUG_OBJECT(v4l2object, "not v4l2 pri event");
4935 return GST_FLOW_OK;
4936 }
xuesong.jiangae1548e2022-05-06 16:38:46 +08004937 memset(&evt, 0x00, sizeof(struct v4l2_event));
4938 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_DQEVENT, &evt) < 0)
4939 goto dqevent_failed;
4940
4941 switch (evt.type)
4942 {
4943 case V4L2_EVENT_SOURCE_CHANGE:
4944 return GST_AML_V4L2_FLOW_SOURCE_CHANGE;
4945 break;
4946 case V4L2_EVENT_EOS:
4947 return GST_AML_V4L2_FLOW_LAST_BUFFER;
4948 break;
4949 default:
4950 break;
4951 }
4952
4953 return GST_FLOW_OK;
4954
4955 /* ERRORS */
4956poll_failed:
4957{
4958 GST_DEBUG_OBJECT(v4l2object, "poll error %s", gst_flow_get_name(res));
4959 return res;
4960}
4961dqevent_failed:
4962{
fei.deng678f7052024-07-10 20:11:26 +08004963 GST_DEBUG_OBJECT(v4l2object, "dqevent failed");
xuesong.jiangae1548e2022-05-06 16:38:46 +08004964 return GST_FLOW_ERROR;
4965}
4966}
4967
4968/**
4969 * gst_aml_v4l2_object_acquire_format:
4970 * @v4l2object the object
4971 * @info a GstVideoInfo to be filled
4972 *
4973 * Acquire the driver choosen format. This is useful in decoder or encoder elements where
4974 * the output format is choosen by the HW.
4975 *
4976 * Returns: %TRUE on success, %FALSE on failure.
4977 */
4978gboolean
4979gst_aml_v4l2_object_acquire_format(GstAmlV4l2Object *v4l2object, GstVideoInfo *info)
4980{
4981 struct v4l2_fmtdesc *fmtdesc;
4982 struct v4l2_format fmt;
4983 struct v4l2_crop crop;
4984 struct v4l2_selection sel;
sheng.liu641aa422023-12-26 07:05:59 +00004985 struct v4l2_cropcap cropcap;
xuesong.jiangae1548e2022-05-06 16:38:46 +08004986 struct v4l2_rect *r = NULL;
4987 GstVideoFormat format;
4988 guint width, height;
4989 GstVideoAlignment align;
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08004990 gint dw_mode;
sheng.liu641aa422023-12-26 07:05:59 +00004991 gdouble pixelAspectRatio = 0.0;
xuesong.jiangae1548e2022-05-06 16:38:46 +08004992
4993 gst_video_info_init(info);
4994 gst_video_alignment_reset(&align);
4995
4996 memset(&fmt, 0x00, sizeof(struct v4l2_format));
4997 fmt.type = v4l2object->type;
fei.denge9458472023-04-18 02:05:48 +00004998 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "fmt.type:%d", fmt.type);
xuesong.jiangae1548e2022-05-06 16:38:46 +08004999 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_FMT, &fmt) < 0)
5000 goto get_fmt_failed;
5001
5002 fmtdesc = gst_aml_v4l2_object_get_format_from_fourcc(v4l2object,
5003 fmt.fmt.pix.pixelformat);
5004 if (fmtdesc == NULL)
5005 goto unsupported_format;
5006
5007 /* No need to care about mplane, the four first params are the same */
5008 format = gst_aml_v4l2_object_v4l2fourcc_to_video_format(fmt.fmt.pix.pixelformat);
5009
5010 /* fails if we do no translate the fmt.pix.pixelformat to GstVideoFormat */
5011 if (format == GST_VIDEO_FORMAT_UNKNOWN)
5012 goto unsupported_format;
5013
5014 if (fmt.fmt.pix.width == 0 || fmt.fmt.pix.height == 0)
5015 goto invalid_dimensions;
5016
5017 width = fmt.fmt.pix.width;
5018 height = fmt.fmt.pix.height;
xuesong.jiangae1548e2022-05-06 16:38:46 +08005019 /* Use the default compose rectangle */
5020 memset(&sel, 0, sizeof(struct v4l2_selection));
5021 sel.type = v4l2object->type;
5022 sel.target = V4L2_SEL_TGT_COMPOSE_DEFAULT;
5023 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_SELECTION, &sel) >= 0)
5024 {
5025 r = &sel.r;
5026 }
5027 else
5028 {
5029 /* For ancient kernels, fall back to G_CROP */
5030 memset(&crop, 0, sizeof(struct v4l2_crop));
5031 crop.type = v4l2object->type;
5032 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_G_CROP, &crop) >= 0)
5033 r = &crop.c;
5034 }
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005035
5036 dw_mode = gst_aml_v4l2_object_get_dw_mode(v4l2object);
sheng.liu07337c82023-12-01 03:21:57 +00005037 if (r)
xuesong.jiangae1548e2022-05-06 16:38:46 +08005038 {
5039 align.padding_left = r->left;
5040 align.padding_top = r->top;
5041 align.padding_right = width - r->width - r->left;
5042 align.padding_bottom = height - r->height - r->top;
5043 width = r->width;
5044 height = r->height;
sheng.liu07337c82023-12-01 03:21:57 +00005045 if (dw_mode >= 0 && dw_mode != 16)
5046 {
5047 width = (width/2) *2; /* align for dw*/
5048 height = (height/2) *2; /* align for dw*/
5049 }
hanghang.luo2dfa0ac2024-07-09 11:33:39 +08005050 if (dw_mode == VDEC_DW_AFBC_ONLY)
5051 height = width = 64;
xuesong.jiangae1548e2022-05-06 16:38:46 +08005052 }
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005053 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "final w:%d, h:%d", width, height);
xuesong.jiangae1548e2022-05-06 16:38:46 +08005054
5055 gst_video_info_set_format(info, format, width, height);
5056
5057 switch (fmt.fmt.pix.field)
5058 {
5059 case V4L2_FIELD_ANY:
5060 case V4L2_FIELD_NONE:
5061 info->interlace_mode = GST_VIDEO_INTERLACE_MODE_PROGRESSIVE;
5062 break;
5063 case V4L2_FIELD_INTERLACED:
5064 case V4L2_FIELD_INTERLACED_TB:
5065 case V4L2_FIELD_INTERLACED_BT:
5066 info->interlace_mode = GST_VIDEO_INTERLACE_MODE_INTERLEAVED;
5067 break;
5068 default:
5069 goto unsupported_field;
5070 }
5071
5072 gst_aml_v4l2_object_get_colorspace(&fmt, &info->colorimetry);
5073
5074 gst_aml_v4l2_object_save_format(v4l2object, fmtdesc, &fmt, info, &align);
5075
sheng.liu641aa422023-12-26 07:05:59 +00005076 if (v4l2object->par)
5077 {
5078 width = gst_value_get_fraction_numerator(v4l2object->par);
5079 height = gst_value_get_fraction_denominator(v4l2object->par);
5080 pixelAspectRatio = (gdouble)width/(gdouble)height;
5081 }
5082
5083 if (!v4l2object->par || pixelAspectRatio == 1.0)
5084 {
5085 memset(&cropcap, 0, sizeof(cropcap));
5086 width= height= 1;
5087 cropcap.type = v4l2object->type;
5088 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_CROPCAP, &cropcap) >= 0)
5089 {
5090 width= cropcap.pixelaspect.denominator;
5091 height= cropcap.pixelaspect.numerator;
5092 GST_DEBUG("cropcap: pixel aspect ratio %d:%d", width, height);
5093 if ( !width || !height )
5094 {
5095 GST_DEBUG("force pixel aspect of 1:1");
5096 width= height= 1;
5097 }
5098 }
sheng.liu641aa422023-12-26 07:05:59 +00005099 }
sheng.liudb26f7d2024-01-22 11:24:23 +00005100
sheng.liud9027ca2024-01-24 09:21:49 +00005101 GST_VIDEO_INFO_PAR_N(info) = width;
5102 GST_VIDEO_INFO_PAR_D(info) = height;
5103
sheng.liudb26f7d2024-01-22 11:24:23 +00005104 if (v4l2object->fps)
5105 {
5106 GST_VIDEO_INFO_FPS_N(info) = gst_value_get_fraction_numerator(v4l2object->fps);
5107 GST_VIDEO_INFO_FPS_D(info) = gst_value_get_fraction_denominator(v4l2object->fps);
5108 }
xuesong.jiangae1548e2022-05-06 16:38:46 +08005109 /* Shall we setup the pool ? */
5110
5111 return TRUE;
5112
5113get_fmt_failed:
5114{
5115 GST_ELEMENT_WARNING(v4l2object->element, RESOURCE, SETTINGS,
5116 (_("Video device did not provide output format.")), GST_ERROR_SYSTEM);
5117 return FALSE;
5118}
5119invalid_dimensions:
5120{
5121 GST_ELEMENT_WARNING(v4l2object->element, RESOURCE, SETTINGS,
5122 (_("Video device returned invalid dimensions.")),
5123 ("Expected non 0 dimensions, got %dx%d", fmt.fmt.pix.width,
5124 fmt.fmt.pix.height));
5125 return FALSE;
5126}
5127unsupported_field:
5128{
5129 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, SETTINGS,
5130 (_("Video device uses an unsupported interlacing method.")),
5131 ("V4L2 field type %d not supported", fmt.fmt.pix.field));
5132 return FALSE;
5133}
5134unsupported_format:
5135{
5136 GST_ELEMENT_ERROR(v4l2object->element, RESOURCE, SETTINGS,
5137 (_("Video device uses an unsupported pixel format.")),
5138 ("V4L2 format %" GST_FOURCC_FORMAT " not supported",
5139 GST_FOURCC_ARGS(fmt.fmt.pix.pixelformat)));
5140 return FALSE;
5141}
5142}
5143
5144gboolean
5145gst_aml_v4l2_object_set_crop(GstAmlV4l2Object *obj)
5146{
5147 struct v4l2_selection sel = {0};
5148 struct v4l2_crop crop = {0};
5149
5150 sel.type = obj->type;
5151 sel.target = V4L2_SEL_TGT_CROP;
5152 sel.flags = 0;
5153 sel.r.left = obj->align.padding_left;
5154 sel.r.top = obj->align.padding_top;
5155 sel.r.width = obj->info.width;
5156 sel.r.height = obj->info.height;
5157
5158 crop.type = obj->type;
5159 crop.c = sel.r;
5160
5161 if (obj->align.padding_left + obj->align.padding_top +
5162 obj->align.padding_right + obj->align.padding_bottom ==
5163 0)
5164 {
5165 GST_DEBUG_OBJECT(obj->dbg_obj, "no cropping needed");
5166 return TRUE;
5167 }
5168
5169 GST_DEBUG_OBJECT(obj->dbg_obj,
5170 "Desired cropping left %u, top %u, size %ux%u", crop.c.left, crop.c.top,
5171 crop.c.width, crop.c.height);
5172
5173 if (obj->ioctl(obj->video_fd, VIDIOC_S_SELECTION, &sel) < 0)
5174 {
5175 if (errno != ENOTTY)
5176 {
5177 GST_WARNING_OBJECT(obj->dbg_obj,
5178 "Failed to set crop rectangle with VIDIOC_S_SELECTION: %s",
5179 g_strerror(errno));
5180 return FALSE;
5181 }
5182 else
5183 {
5184 if (obj->ioctl(obj->video_fd, VIDIOC_S_CROP, &crop) < 0)
5185 {
5186 GST_WARNING_OBJECT(obj->dbg_obj, "VIDIOC_S_CROP failed");
5187 return FALSE;
5188 }
5189
5190 if (obj->ioctl(obj->video_fd, VIDIOC_G_CROP, &crop) < 0)
5191 {
5192 GST_WARNING_OBJECT(obj->dbg_obj, "VIDIOC_G_CROP failed");
5193 return FALSE;
5194 }
5195
5196 sel.r = crop.c;
5197 }
5198 }
5199
5200 GST_DEBUG_OBJECT(obj->dbg_obj,
5201 "Got cropping left %u, top %u, size %ux%u", crop.c.left, crop.c.top,
5202 crop.c.width, crop.c.height);
5203
5204 return TRUE;
5205}
5206
5207gboolean
5208gst_aml_v4l2_object_caps_equal(GstAmlV4l2Object *v4l2object, GstCaps *caps)
5209{
5210 GstStructure *config;
5211 GstCaps *oldcaps;
5212 gboolean ret;
5213
5214 if (!v4l2object->pool)
5215 return FALSE;
5216
5217 config = gst_buffer_pool_get_config(v4l2object->pool);
5218 gst_buffer_pool_config_get_params(config, &oldcaps, NULL, NULL, NULL);
5219
5220 ret = oldcaps && gst_caps_is_equal(caps, oldcaps);
5221
5222 gst_structure_free(config);
5223
5224 return ret;
5225}
5226
5227gboolean
5228gst_aml_v4l2_object_caps_is_subset(GstAmlV4l2Object *v4l2object, GstCaps *caps)
5229{
5230 GstStructure *config;
5231 GstCaps *oldcaps;
5232 gboolean ret;
5233
5234 if (!v4l2object->pool)
5235 return FALSE;
5236
5237 config = gst_buffer_pool_get_config(v4l2object->pool);
5238 gst_buffer_pool_config_get_params(config, &oldcaps, NULL, NULL, NULL);
5239
5240 ret = oldcaps && gst_caps_is_subset(oldcaps, caps);
5241
5242 gst_structure_free(config);
5243
5244 return ret;
5245}
5246
5247GstCaps *
5248gst_aml_v4l2_object_get_current_caps(GstAmlV4l2Object *v4l2object)
5249{
5250 GstStructure *config;
5251 GstCaps *oldcaps;
5252
5253 if (!v4l2object->pool)
5254 return NULL;
5255
5256 config = gst_buffer_pool_get_config(v4l2object->pool);
5257 gst_buffer_pool_config_get_params(config, &oldcaps, NULL, NULL, NULL);
5258
5259 if (oldcaps)
5260 gst_caps_ref(oldcaps);
5261
5262 gst_structure_free(config);
5263
5264 return oldcaps;
5265}
5266
5267gboolean
5268gst_aml_v4l2_object_unlock(GstAmlV4l2Object *v4l2object)
5269{
5270 gboolean ret = TRUE;
5271
5272 GST_LOG_OBJECT(v4l2object->dbg_obj, "start flushing");
5273
5274 gst_poll_set_flushing(v4l2object->poll, TRUE);
5275
5276 if (v4l2object->pool && gst_buffer_pool_is_active(v4l2object->pool))
5277 gst_buffer_pool_set_flushing(v4l2object->pool, TRUE);
5278
5279 return ret;
5280}
5281
5282gboolean
5283gst_aml_v4l2_object_unlock_stop(GstAmlV4l2Object *v4l2object)
5284{
5285 gboolean ret = TRUE;
5286
5287 GST_LOG_OBJECT(v4l2object->dbg_obj, "stop flushing");
5288
5289 if (v4l2object->pool && gst_buffer_pool_is_active(v4l2object->pool))
5290 gst_buffer_pool_set_flushing(v4l2object->pool, FALSE);
5291
5292 gst_poll_set_flushing(v4l2object->poll, FALSE);
5293
5294 return ret;
5295}
5296
5297gboolean
5298gst_aml_v4l2_object_stop(GstAmlV4l2Object *v4l2object)
5299{
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005300 GstAmlV4l2BufferPool *bpool = GST_AML_V4L2_BUFFER_POOL(v4l2object->pool);
5301
xuesong.jiangae1548e2022-05-06 16:38:46 +08005302 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "stopping");
5303
5304 if (!GST_AML_V4L2_IS_OPEN(v4l2object))
5305 goto done;
5306 if (!GST_AML_V4L2_IS_ACTIVE(v4l2object))
5307 goto done;
5308
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005309 if (bpool && bpool->other_pool) /* jxsdbg for resolution switch */
5310 {
5311 if (v4l2object->old_other_pool)
5312 {
5313 /* this case indicate 1st switch did not wait all old pool buf recycle and 2nd switch is coming.
5314 so save 1st old pool */
5315 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "switching occurs during last switching buf recycle flow");
5316 v4l2object->old_old_other_pool = v4l2object->old_other_pool;
5317 }
5318
5319 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "switching flow, ref old drmbufferpool");
5320 v4l2object->old_other_pool = bpool->other_pool;
5321 gst_object_ref(v4l2object->old_other_pool);
5322 }
5323
xuesong.jiangae1548e2022-05-06 16:38:46 +08005324 if (v4l2object->pool)
5325 {
5326 if (!gst_aml_v4l2_buffer_pool_orphan(&v4l2object->pool))
5327 {
5328 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "deactivating pool");
5329 gst_buffer_pool_set_active(v4l2object->pool, FALSE);
5330 gst_object_unref(v4l2object->pool);
5331 }
5332 v4l2object->pool = NULL;
5333 }
5334
5335 GST_AML_V4L2_SET_INACTIVE(v4l2object);
5336
5337done:
5338 return TRUE;
5339}
5340
5341GstCaps *
5342gst_aml_v4l2_object_probe_caps(GstAmlV4l2Object *v4l2object, GstCaps *filter)
5343{
5344 GstCaps *ret;
5345 GSList *walk;
5346 GSList *formats;
5347
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005348 GST_INFO_OBJECT(v4l2object->dbg_obj, "filter caps: %" GST_PTR_FORMAT, filter);
xuesong.jiangae1548e2022-05-06 16:38:46 +08005349 formats = gst_aml_v4l2_object_get_format_list(v4l2object);
5350
5351 ret = gst_caps_new_empty();
5352
sheng.liu641aa422023-12-26 07:05:59 +00005353// At this time, decoder will return defult aspect, and it is not usful.
5354// so, do not probe cropcap at this time and do this action after decoding.
5355#if 0
xuesong.jiangae1548e2022-05-06 16:38:46 +08005356 if (v4l2object->keep_aspect && !v4l2object->par)
5357 {
5358 struct v4l2_cropcap cropcap;
5359
5360 memset(&cropcap, 0, sizeof(cropcap));
5361
5362 cropcap.type = v4l2object->type;
5363 if (v4l2object->ioctl(v4l2object->video_fd, VIDIOC_CROPCAP, &cropcap) < 0)
5364 {
5365 if (errno != ENOTTY)
5366 GST_WARNING_OBJECT(v4l2object->dbg_obj,
5367 "Failed to probe pixel aspect ratio with VIDIOC_CROPCAP: %s",
5368 g_strerror(errno));
5369 }
5370 else if (cropcap.pixelaspect.numerator && cropcap.pixelaspect.denominator)
5371 {
5372 v4l2object->par = g_new0(GValue, 1);
5373 g_value_init(v4l2object->par, GST_TYPE_FRACTION);
5374 gst_value_set_fraction(v4l2object->par, cropcap.pixelaspect.numerator,
5375 cropcap.pixelaspect.denominator);
5376 }
5377 }
sheng.liu641aa422023-12-26 07:05:59 +00005378#endif
xuesong.jiangae1548e2022-05-06 16:38:46 +08005379
5380 for (walk = formats; walk; walk = walk->next)
5381 {
5382 struct v4l2_fmtdesc *format;
5383 GstStructure *template;
5384 GstCaps *tmp, *tmp2;
5385
5386 format = (struct v4l2_fmtdesc *)walk->data;
5387
5388 template = gst_aml_v4l2_object_v4l2fourcc_to_bare_struct(format->pixelformat);
5389
5390 if (!template)
5391 {
5392 GST_DEBUG_OBJECT(v4l2object->dbg_obj,
5393 "unknown format %" GST_FOURCC_FORMAT,
5394 GST_FOURCC_ARGS(format->pixelformat));
5395 continue;
5396 }
5397
5398 /* If we have a filter, check if we need to probe this format or not */
5399 if (filter)
5400 {
5401 GstCaps *format_caps = gst_caps_new_empty();
5402
5403 gst_caps_append_structure(format_caps, gst_structure_copy(template));
xuesong.jiange1a19662022-06-21 20:30:22 +08005404 GST_INFO_OBJECT(v4l2object->dbg_obj, "format_caps: %" GST_PTR_FORMAT, format_caps);
xuesong.jiangae1548e2022-05-06 16:38:46 +08005405
5406 if (!gst_caps_can_intersect(format_caps, filter))
5407 {
5408 gst_caps_unref(format_caps);
5409 gst_structure_free(template);
5410 continue;
5411 }
5412
5413 gst_caps_unref(format_caps);
5414 }
5415
5416 tmp = gst_aml_v4l2_object_probe_caps_for_format(v4l2object,
5417 format->pixelformat, template);
xuesong.jiange1a19662022-06-21 20:30:22 +08005418 GST_INFO_OBJECT(v4l2object->dbg_obj, "tmp caps: %" GST_PTR_FORMAT, tmp);
xuesong.jiangae1548e2022-05-06 16:38:46 +08005419
5420 if (tmp)
5421 {
5422 tmp2 = gst_caps_copy(tmp);
5423 gst_caps_set_features_simple(tmp2, gst_caps_features_from_string(GST_CAPS_FEATURE_MEMORY_DMABUF));
5424 gst_caps_append(ret, tmp);
5425 gst_caps_append(ret, tmp2);
5426 }
5427
5428 gst_structure_free(template);
5429 }
5430
5431 if (filter)
5432 {
5433 GstCaps *tmp;
5434
5435 tmp = ret;
5436 ret = gst_caps_intersect_full(filter, ret, GST_CAPS_INTERSECT_FIRST);
5437 gst_caps_unref(tmp);
5438 }
5439
xuesong.jiang22a9b112023-05-24 09:01:59 +00005440 if (v4l2object->stream_mode)
5441 {
5442 GST_INFO_OBJECT(v4l2object->dbg_obj, "ret caps: %" GST_PTR_FORMAT, ret);
5443 for (guint i = 0; i < gst_caps_get_size(ret); i++)
5444 {
5445 GstStructure *s = gst_caps_get_structure(ret, i);
5446 if (s)
5447 gst_structure_remove_field(s, "alignment");
5448
5449 GST_DEBUG("i:%d, s:%p", i, s);
5450 }
5451 GST_INFO_OBJECT(v4l2object->dbg_obj, "new ret caps: %" GST_PTR_FORMAT, ret);
5452 }
5453
xuesong.jiangae1548e2022-05-06 16:38:46 +08005454 GST_INFO_OBJECT(v4l2object->dbg_obj, "probed caps: %" GST_PTR_FORMAT, ret);
5455
5456 return ret;
5457}
5458
5459GstCaps *
5460gst_aml_v4l2_object_get_caps(GstAmlV4l2Object *v4l2object, GstCaps *filter)
5461{
5462 GstCaps *ret;
5463
5464 if (v4l2object->probed_caps == NULL)
5465 v4l2object->probed_caps = gst_aml_v4l2_object_probe_caps(v4l2object, NULL);
5466
5467 if (filter)
5468 {
5469 ret = gst_caps_intersect_full(filter, v4l2object->probed_caps,
5470 GST_CAPS_INTERSECT_FIRST);
5471 }
5472 else
5473 {
5474 ret = gst_caps_ref(v4l2object->probed_caps);
5475 }
5476
5477 return ret;
5478}
5479
5480gboolean
5481gst_aml_v4l2_object_decide_allocation(GstAmlV4l2Object *obj, GstQuery *query)
5482{
5483 GstCaps *caps;
5484 GstBufferPool *pool = NULL, *other_pool = NULL;
5485 GstStructure *config;
5486 guint size, min, max, own_min = 0;
5487 gboolean update;
5488 gboolean has_video_meta;
5489 gboolean can_share_own_pool, pushing_from_our_pool = FALSE;
5490 GstAllocator *allocator = NULL;
5491 GstAllocationParams params = {0};
5492
5493 GST_DEBUG_OBJECT(obj->dbg_obj, "decide allocation");
5494
5495 g_return_val_if_fail(obj->type == V4L2_BUF_TYPE_VIDEO_CAPTURE ||
5496 obj->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE,
5497 FALSE);
5498
5499 gst_query_parse_allocation(query, &caps, NULL);
5500
5501 if (obj->pool == NULL)
5502 {
5503 if (!gst_aml_v4l2_object_setup_pool(obj, caps))
5504 goto pool_failed;
5505 }
5506
5507 if (gst_query_get_n_allocation_params(query) > 0)
5508 gst_query_parse_nth_allocation_param(query, 0, &allocator, &params);
5509
5510 if (gst_query_get_n_allocation_pools(query) > 0)
5511 {
5512 gst_query_parse_nth_allocation_pool(query, 0, &pool, &size, &min, &max);
5513 update = TRUE;
5514 }
5515 else
5516 {
5517 pool = NULL;
5518 min = max = 0;
5519 size = 0;
5520 update = FALSE;
5521 }
5522
5523 GST_DEBUG_OBJECT(obj->dbg_obj, "allocation: size:%u min:%u max:%u pool:%" GST_PTR_FORMAT, size, min, max, pool);
5524
5525 has_video_meta =
5526 gst_query_find_allocation_meta(query, GST_VIDEO_META_API_TYPE, NULL);
5527
5528 can_share_own_pool = (has_video_meta || !obj->need_video_meta);
5529
5530 gst_aml_v4l2_get_driver_min_buffers(obj);
5531 /* We can't share our own pool, if it exceed V4L2 capacity */
5532 if (min + obj->min_buffers + 1 > VIDEO_MAX_FRAME)
5533 can_share_own_pool = FALSE;
5534
5535 /* select a pool */
5536 switch (obj->mode)
5537 {
5538 case GST_V4L2_IO_RW:
5539 if (pool)
5540 {
5541 /* in READ/WRITE mode, prefer a downstream pool because our own pool
5542 * doesn't help much, we have to write to it as well */
5543 GST_DEBUG_OBJECT(obj->dbg_obj,
5544 "read/write mode: using downstream pool");
5545 /* use the bigest size, when we use our own pool we can't really do any
5546 * other size than what the hardware gives us but for downstream pools
5547 * we can try */
5548 size = MAX(size, obj->info.size);
5549 }
5550 else if (can_share_own_pool)
5551 {
5552 /* no downstream pool, use our own then */
5553 GST_DEBUG_OBJECT(obj->dbg_obj,
5554 "read/write mode: no downstream pool, using our own");
5555 pool = gst_object_ref(obj->pool);
5556 size = obj->info.size;
5557 pushing_from_our_pool = TRUE;
5558 }
5559 break;
5560
5561 case GST_V4L2_IO_USERPTR:
5562 case GST_V4L2_IO_DMABUF_IMPORT:
5563 /* in importing mode, prefer our own pool, and pass the other pool to
5564 * our own, so it can serve itself */
5565 if (pool == NULL)
5566 goto no_downstream_pool;
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005567 gst_aml_v4l2_buffer_pool_set_other_pool(GST_AML_V4L2_BUFFER_POOL(obj->pool), pool);
xuesong.jiangae1548e2022-05-06 16:38:46 +08005568 other_pool = pool;
5569 gst_object_unref(pool);
5570 pool = gst_object_ref(obj->pool);
5571 size = obj->info.size;
5572 break;
5573
5574 case GST_V4L2_IO_MMAP:
5575 case GST_V4L2_IO_DMABUF:
5576 /* in streaming mode, prefer our own pool */
5577 /* Check if we can use it ... */
5578 if (can_share_own_pool)
5579 {
5580 if (pool)
5581 gst_object_unref(pool);
5582 pool = gst_object_ref(obj->pool);
5583 size = obj->info.size;
5584 GST_DEBUG_OBJECT(obj->dbg_obj,
5585 "streaming mode: using our own pool %" GST_PTR_FORMAT, pool);
5586 pushing_from_our_pool = TRUE;
5587 }
5588 else if (pool)
5589 {
5590 GST_DEBUG_OBJECT(obj->dbg_obj,
5591 "streaming mode: copying to downstream pool %" GST_PTR_FORMAT,
5592 pool);
5593 }
5594 else
5595 {
5596 GST_DEBUG_OBJECT(obj->dbg_obj,
5597 "streaming mode: no usable pool, copying to generic pool");
5598 size = MAX(size, obj->info.size);
5599 }
5600 break;
5601 case GST_V4L2_IO_AUTO:
5602 default:
5603 GST_WARNING_OBJECT(obj->dbg_obj, "unhandled mode");
5604 break;
5605 }
5606
5607 if (size == 0)
5608 goto no_size;
5609
5610 /* If pushing from our own pool, configure it with queried minimum,
5611 * otherwise use the minimum required */
5612 if (pushing_from_our_pool)
5613 {
5614 /* When pushing from our own pool, we need what downstream one, to be able
5615 * to fill the pipeline, the minimum required to decoder according to the
5616 * driver and 2 more, so we don't endup up with everything downstream or
5617 * held by the decoder. We account 2 buffers for v4l2 so when one is being
5618 * pushed downstream the other one can already be queued for the next
5619 * frame. */
5620 own_min = min + obj->min_buffers + 2;
5621
5622 /* If no allocation parameters where provided, allow for a little more
5623 * buffers and enable copy threshold */
5624 if (!update)
5625 {
5626 own_min += 2;
5627 gst_aml_v4l2_buffer_pool_copy_at_threshold(GST_AML_V4L2_BUFFER_POOL(pool),
5628 TRUE);
5629 }
5630 else
5631 {
5632 gst_aml_v4l2_buffer_pool_copy_at_threshold(GST_AML_V4L2_BUFFER_POOL(pool),
5633 FALSE);
5634 }
5635 }
5636 else
5637 {
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005638 min = obj->min_buffers;
5639 max = min;
xuesong.jiangae1548e2022-05-06 16:38:46 +08005640 }
5641
5642 /* Request a bigger max, if one was suggested but it's too small */
5643 if (max != 0)
5644 max = MAX(min, max);
5645
5646 /* First step, configure our own pool */
5647 config = gst_buffer_pool_get_config(obj->pool);
5648
5649 if (obj->need_video_meta || has_video_meta)
5650 {
5651 GST_DEBUG_OBJECT(obj->dbg_obj, "activate Video Meta");
5652 gst_buffer_pool_config_add_option(config,
5653 GST_BUFFER_POOL_OPTION_VIDEO_META);
5654 }
5655
5656 gst_buffer_pool_config_set_allocator(config, allocator, &params);
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005657 gst_buffer_pool_config_set_params(config, caps, size, min, max);
xuesong.jiangae1548e2022-05-06 16:38:46 +08005658
5659 GST_DEBUG_OBJECT(obj->dbg_obj, "setting own pool config to %" GST_PTR_FORMAT, config);
5660
5661 /* Our pool often need to adjust the value */
5662 if (!gst_buffer_pool_set_config(obj->pool, config))
5663 {
5664 config = gst_buffer_pool_get_config(obj->pool);
5665
5666 GST_DEBUG_OBJECT(obj->dbg_obj, "own pool config changed to %" GST_PTR_FORMAT, config);
5667
5668 /* our pool will adjust the maximum buffer, which we are fine with */
5669 if (!gst_buffer_pool_set_config(obj->pool, config))
5670 goto config_failed;
5671 }
5672
5673 /* Now configure the other pool if different */
5674 if (obj->pool != pool)
5675 other_pool = pool;
5676
5677 if (other_pool)
5678 {
5679 GstAmlV4l2VideoDec *self = (GstAmlV4l2VideoDec *)obj->element;
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005680 guint other_min = min;
5681 guint other_max = max;
5682
5683 if (obj->old_other_pool || obj->old_old_other_pool) //jxsdbg for switching
5684 {
5685 obj->outstanding_buf_num = gst_aml_v4l2_object_get_outstanding_capture_buf_num(obj);
5686 other_min = min - obj->outstanding_buf_num;
5687 other_max = max - obj->outstanding_buf_num;
5688 GST_DEBUG_OBJECT(obj, "oop:%p, ooop:%p, outstanding buf num:%d, set min, max to %d,%d",
5689 obj->old_other_pool, obj->old_old_other_pool,
5690 obj->outstanding_buf_num, other_min, other_max);
5691 }
5692
xuesong.jiangae1548e2022-05-06 16:38:46 +08005693 if (self->is_secure_path)
5694 {
5695 params.flags |= GST_MEMORY_FLAG_LAST << 1; // in drmallocator GST_MEMORY_FLAG_LAST << 1 represent GST_MEMORY_FLAG_SECURE
5696 GST_DEBUG_OBJECT(obj, "set secure flag for drmbufferpool flag:0x%x", params.flags);
5697 }
5698 config = gst_buffer_pool_get_config(other_pool);
5699 gst_buffer_pool_config_set_allocator(config, allocator, &params);
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08005700 gst_buffer_pool_config_set_params (config, caps, size, other_min, other_max);
xuesong.jiangae1548e2022-05-06 16:38:46 +08005701 gst_buffer_pool_config_set_video_alignment(config, &obj->align);
5702
5703 GST_DEBUG_OBJECT(obj->dbg_obj, "setting other pool config to %" GST_PTR_FORMAT, config);
5704
5705 /* if downstream supports video metadata, add this to the pool config */
5706 if (has_video_meta)
5707 {
5708 GST_DEBUG_OBJECT(obj->dbg_obj, "activate Video Meta");
5709 gst_buffer_pool_config_add_option(config,
5710 GST_BUFFER_POOL_OPTION_VIDEO_META);
5711 }
5712
5713 if (!gst_buffer_pool_set_config(other_pool, config))
5714 {
5715 config = gst_buffer_pool_get_config(other_pool);
5716
5717 if (!gst_buffer_pool_config_validate_params(config, caps, size, min,
5718 max))
5719 {
5720 gst_structure_free(config);
5721 goto config_failed;
5722 }
5723
5724 if (!gst_buffer_pool_set_config(other_pool, config))
5725 goto config_failed;
5726 }
5727 }
5728
5729 if (pool)
5730 {
5731 /* For simplicity, simply read back the active configuration, so our base
5732 * class get the right information */
5733 config = gst_buffer_pool_get_config(pool);
5734 gst_buffer_pool_config_get_params(config, NULL, &size, &min, &max);
5735 gst_structure_free(config);
5736 }
5737
5738 if (update)
5739 gst_query_set_nth_allocation_pool(query, 0, pool, size, min, max);
5740 else
5741 gst_query_add_allocation_pool(query, pool, size, min, max);
5742
5743 if (allocator)
5744 gst_object_unref(allocator);
5745
5746 if (pool)
5747 gst_object_unref(pool);
5748
5749 return TRUE;
5750
5751pool_failed:
5752{
5753 /* setup_pool already send the error */
5754 goto cleanup;
5755}
5756config_failed:
5757{
5758 GST_ELEMENT_ERROR(obj->element, RESOURCE, SETTINGS,
5759 (_("Failed to configure internal buffer pool.")), (NULL));
5760 goto cleanup;
5761}
5762no_size:
5763{
5764 GST_ELEMENT_ERROR(obj->element, RESOURCE, SETTINGS,
5765 (_("Video device did not suggest any buffer size.")), (NULL));
5766 goto cleanup;
5767}
5768cleanup:
5769{
5770 if (allocator)
5771 gst_object_unref(allocator);
5772
5773 if (pool)
5774 gst_object_unref(pool);
5775 return FALSE;
5776}
5777no_downstream_pool:
5778{
5779 GST_ELEMENT_ERROR(obj->element, RESOURCE, SETTINGS,
5780 (_("No downstream pool to import from.")),
5781 ("When importing DMABUF or USERPTR, we need a pool to import from"));
5782 return FALSE;
5783}
5784}
5785
5786gboolean
5787gst_aml_v4l2_object_propose_allocation(GstAmlV4l2Object *obj, GstQuery *query)
5788{
5789 GstBufferPool *pool;
5790 /* we need at least 2 buffers to operate */
5791 guint size, min, max;
5792 GstCaps *caps;
5793 gboolean need_pool;
5794
5795 /* Set defaults allocation parameters */
5796 size = obj->info.size;
5797 min = GST_AML_V4L2_MIN_BUFFERS;
5798 max = VIDEO_MAX_FRAME;
5799
5800 gst_query_parse_allocation(query, &caps, &need_pool);
5801
5802 if (caps == NULL)
5803 goto no_caps;
5804
5805 switch (obj->mode)
5806 {
5807 case GST_V4L2_IO_MMAP:
5808 case GST_V4L2_IO_DMABUF:
5809 if ((pool = obj->pool))
5810 gst_object_ref(pool);
5811 break;
5812 default:
5813 pool = NULL;
5814 break;
5815 }
5816
5817 if (pool != NULL)
5818 {
5819 GstCaps *pcaps;
5820 GstStructure *config;
5821
5822 /* we had a pool, check caps */
5823 config = gst_buffer_pool_get_config(pool);
5824 gst_buffer_pool_config_get_params(config, &pcaps, NULL, NULL, NULL);
5825
5826 GST_DEBUG_OBJECT(obj->dbg_obj,
5827 "we had a pool with caps %" GST_PTR_FORMAT, pcaps);
5828 if (!gst_caps_is_equal(caps, pcaps))
5829 {
5830 gst_structure_free(config);
5831 gst_object_unref(pool);
5832 goto different_caps;
5833 }
5834 gst_structure_free(config);
5835 }
5836 gst_aml_v4l2_get_driver_min_buffers(obj);
5837
5838 min = MAX(obj->min_buffers, GST_AML_V4L2_MIN_BUFFERS);
5839
5840 gst_query_add_allocation_pool(query, pool, size, min, max);
5841
5842 /* we also support various metadata */
5843 gst_query_add_allocation_meta(query, GST_VIDEO_META_API_TYPE, NULL);
5844
5845 if (pool)
5846 gst_object_unref(pool);
5847
5848 return TRUE;
5849
5850 /* ERRORS */
5851no_caps:
5852{
5853 GST_DEBUG_OBJECT(obj->dbg_obj, "no caps specified");
5854 return FALSE;
5855}
5856different_caps:
5857{
5858 /* different caps, we can't use this pool */
5859 GST_DEBUG_OBJECT(obj->dbg_obj, "pool has different caps");
5860 return FALSE;
5861}
5862}
5863
5864gboolean
5865gst_aml_v4l2_object_try_import(GstAmlV4l2Object *obj, GstBuffer *buffer)
5866{
5867 GstVideoMeta *vmeta;
5868 guint n_mem = gst_buffer_n_memory(buffer);
5869
5870 /* only import if requested */
5871 switch (obj->mode)
5872 {
5873 case GST_V4L2_IO_USERPTR:
5874 case GST_V4L2_IO_DMABUF_IMPORT:
5875 break;
5876 default:
5877 GST_DEBUG_OBJECT(obj->dbg_obj,
5878 "The io-mode does not enable importation");
5879 return FALSE;
5880 }
5881
5882 vmeta = gst_buffer_get_video_meta(buffer);
5883 if (!vmeta && obj->need_video_meta)
5884 {
5885 GST_DEBUG_OBJECT(obj->dbg_obj, "Downstream buffer uses standard "
5886 "stride/offset while the driver does not.");
5887 return FALSE;
5888 }
5889
5890 /* we need matching strides/offsets and size */
5891 if (vmeta)
5892 {
5893 guint p;
5894 gboolean need_fmt_update = FALSE;
5895
5896 if (vmeta->n_planes != GST_VIDEO_INFO_N_PLANES(&obj->info))
5897 {
5898 GST_WARNING_OBJECT(obj->dbg_obj,
5899 "Cannot import buffers with different number planes");
5900 return FALSE;
5901 }
5902
5903 for (p = 0; p < vmeta->n_planes; p++)
5904 {
5905 if (vmeta->stride[p] < obj->info.stride[p])
5906 {
5907 GST_DEBUG_OBJECT(obj->dbg_obj,
5908 "Not importing as remote stride %i is smaller then %i on plane %u",
5909 vmeta->stride[p], obj->info.stride[p], p);
5910 return FALSE;
5911 }
5912 else if (vmeta->stride[p] > obj->info.stride[p])
5913 {
5914 need_fmt_update = TRUE;
5915 }
5916
5917 if (vmeta->offset[p] < obj->info.offset[p])
5918 {
5919 GST_DEBUG_OBJECT(obj->dbg_obj,
5920 "Not importing as offset %" G_GSIZE_FORMAT
5921 " is smaller then %" G_GSIZE_FORMAT " on plane %u",
5922 vmeta->offset[p], obj->info.offset[p], p);
5923 return FALSE;
5924 }
5925 else if (vmeta->offset[p] > obj->info.offset[p])
5926 {
5927 need_fmt_update = TRUE;
5928 }
5929 }
5930
5931 if (need_fmt_update)
5932 {
5933 struct v4l2_format format;
5934 gint wanted_stride[GST_VIDEO_MAX_PLANES] = {
5935 0,
5936 };
5937
5938 format = obj->format;
5939
5940 /* update the current format with the stride we want to import from */
5941 if (V4L2_TYPE_IS_MULTIPLANAR(obj->type))
5942 {
5943 guint i;
5944
5945 GST_DEBUG_OBJECT(obj->dbg_obj, "Wanted strides:");
5946
5947 for (i = 0; i < obj->n_v4l2_planes; i++)
5948 {
5949 gint stride = vmeta->stride[i];
5950
5951 if (GST_VIDEO_FORMAT_INFO_IS_TILED(obj->info.finfo))
5952 stride = GST_VIDEO_TILE_X_TILES(stride) << GST_VIDEO_FORMAT_INFO_TILE_WS(obj->info.finfo);
5953
5954 format.fmt.pix_mp.plane_fmt[i].bytesperline = stride;
5955 wanted_stride[i] = stride;
5956 GST_DEBUG_OBJECT(obj->dbg_obj, " [%u] %i", i, wanted_stride[i]);
5957 }
5958 }
5959 else
5960 {
5961 gint stride = vmeta->stride[0];
5962
5963 GST_DEBUG_OBJECT(obj->dbg_obj, "Wanted stride: %i", stride);
5964
5965 if (GST_VIDEO_FORMAT_INFO_IS_TILED(obj->info.finfo))
5966 stride = GST_VIDEO_TILE_X_TILES(stride) << GST_VIDEO_FORMAT_INFO_TILE_WS(obj->info.finfo);
5967
5968 format.fmt.pix.bytesperline = stride;
5969 wanted_stride[0] = stride;
5970 }
5971
5972 if (obj->ioctl(obj->video_fd, VIDIOC_S_FMT, &format) < 0)
5973 {
5974 GST_WARNING_OBJECT(obj->dbg_obj,
5975 "Something went wrong trying to update current format: %s",
5976 g_strerror(errno));
5977 return FALSE;
5978 }
5979
5980 gst_aml_v4l2_object_save_format(obj, obj->fmtdesc, &format, &obj->info,
5981 &obj->align);
5982
5983 if (V4L2_TYPE_IS_MULTIPLANAR(obj->type))
5984 {
5985 guint i;
5986
5987 for (i = 0; i < obj->n_v4l2_planes; i++)
5988 {
5989 if (format.fmt.pix_mp.plane_fmt[i].bytesperline != wanted_stride[i])
5990 {
5991 GST_DEBUG_OBJECT(obj->dbg_obj,
5992 "[%i] Driver did not accept the new stride (wants %i, got %i)",
5993 i, format.fmt.pix_mp.plane_fmt[i].bytesperline,
5994 wanted_stride[i]);
5995 return FALSE;
5996 }
5997 }
5998 }
5999 else
6000 {
6001 if (format.fmt.pix.bytesperline != wanted_stride[0])
6002 {
6003 GST_DEBUG_OBJECT(obj->dbg_obj,
6004 "Driver did not accept the new stride (wants %i, got %i)",
6005 format.fmt.pix.bytesperline, wanted_stride[0]);
6006 return FALSE;
6007 }
6008 }
6009 }
6010 }
6011
6012 /* we can always import single memory buffer, but otherwise we need the same
6013 * amount of memory object. */
6014 if (n_mem != 1 && n_mem != obj->n_v4l2_planes)
6015 {
6016 GST_DEBUG_OBJECT(obj->dbg_obj, "Can only import %i memory, "
6017 "buffers contains %u memory",
6018 obj->n_v4l2_planes, n_mem);
6019 return FALSE;
6020 }
6021
6022 /* For DMABuf importation we need DMABuf of course */
6023 if (obj->mode == GST_V4L2_IO_DMABUF_IMPORT)
6024 {
6025 guint i;
6026
6027 for (i = 0; i < n_mem; i++)
6028 {
6029 GstMemory *mem = gst_buffer_peek_memory(buffer, i);
6030
6031 if (!gst_is_dmabuf_memory(mem))
6032 {
6033 GST_DEBUG_OBJECT(obj->dbg_obj, "Cannot import non-DMABuf memory.");
6034 return FALSE;
6035 }
6036 }
6037 }
6038
6039 /* for the remaining, only the kernel driver can tell */
6040 return TRUE;
6041}
6042
xuesong.jiang22a9b112023-05-24 09:01:59 +00006043static gboolean gst_aml_v4l2_set_control(GstAmlV4l2Object *v4l2object, guint ctl)
6044{
6045 int rc;
6046 struct v4l2_queryctrl queryctrl;
6047 struct v4l2_control control;
6048
6049 GstAmlV4l2VideoDec *self = (GstAmlV4l2VideoDec *)v4l2object->element;
6050 self->is_secure_path = TRUE;
6051
6052 memset(&queryctrl, 0, sizeof(queryctrl));
6053 queryctrl.id = ctl;
6054
6055 rc = v4l2object->ioctl(v4l2object->video_fd, VIDIOC_QUERYCTRL, &queryctrl);
6056 if (rc == 0)
6057 {
6058 if (!(queryctrl.flags & V4L2_CTRL_FLAG_DISABLED))
6059 {
6060 memset(&control, 0, sizeof(control));
6061 control.id = ctl;
6062 control.value = 1;
6063 rc = v4l2object->ioctl(v4l2object->video_fd, VIDIOC_S_CTRL, &control);
6064 if (rc != 0)
6065 {
6066 GST_ERROR_OBJECT(v4l2object->dbg_obj, "set ctl:0x%x fail rc %d", ctl, rc);
6067 return FALSE;
6068 }
6069 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "set ctl:0x%x succ", ctl);
6070 return TRUE;
6071 }
6072 else
6073 {
6074 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "ctl:0x%x is disabled", ctl);
6075 return TRUE;
6076 }
6077 }
6078 else
6079 {
6080 GST_ERROR_OBJECT(v4l2object->dbg_obj, "VIDIOC_QUERYCTRL for 0x:%x fail", ctl);
6081 return FALSE;
6082 }
6083}
6084
hanghang.luo7f403102024-07-04 10:33:01 +08006085gboolean gst_aml_v4l2_set_I_frame_mode(GstAmlV4l2Object *v4l2object)
6086{
6087 if (v4l2object->iframe_mode)
6088 {
6089 int rc;
6090 struct v4l2_control control;
6091 memset(&control, 0, sizeof(control));
6092 control.id = AML_V4L2_SET_I_FRAME;
6093 control.value = 1;
6094 rc = v4l2object->ioctl(v4l2object->video_fd, VIDIOC_S_CTRL, &control);
6095 if (rc != 0)
6096 {
6097 GST_ERROR_OBJECT(v4l2object->dbg_obj, "rc: %d", rc);
6098 return FALSE;
6099 }
6100 }
hanghang.luoac6df002024-07-11 10:54:17 +08006101 GST_DEBUG("set I frame ok");
hanghang.luo7f403102024-07-04 10:33:01 +08006102 return TRUE;
6103}
xuesong.jiang22a9b112023-05-24 09:01:59 +00006104
xuesong.jiangae1548e2022-05-06 16:38:46 +08006105gboolean gst_aml_v4l2_set_drm_mode(GstAmlV4l2Object *v4l2object)
6106{
6107 /* On AmLogic, output obj use of GST_V4L2_IO_DMABUF_IMPORT implies secure memory */
6108 if (v4l2object->req_mode == GST_V4L2_IO_DMABUF_IMPORT)
6109 {
xuesong.jiangae1548e2022-05-06 16:38:46 +08006110
xuesong.jiang22a9b112023-05-24 09:01:59 +00006111 if (gst_aml_v4l2_set_control(v4l2object, AML_V4L2_SET_DRMMODE))
xuesong.jiangae1548e2022-05-06 16:38:46 +08006112 {
xuesong.jiang22a9b112023-05-24 09:01:59 +00006113 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "AML_V4L2_SET_DRMMODE set succ");
6114 return TRUE;
xuesong.jiangae1548e2022-05-06 16:38:46 +08006115 }
6116 else
6117 {
xuesong.jiang22a9b112023-05-24 09:01:59 +00006118 GST_ERROR_OBJECT(v4l2object->dbg_obj, "AML_V4L2_SET_DRMMODE set fail");
xuesong.jiangae1548e2022-05-06 16:38:46 +08006119 return FALSE;
6120 }
6121 }
6122 else
6123 {
xuesong.jiang22a9b112023-05-24 09:01:59 +00006124 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "req mode is not GST_V4L2_IO_DMABUF_IMPORT, DRM mode does not need to be configured");
6125 return TRUE;
6126 }
6127}
6128
6129gboolean gst_aml_v4l2_set_stream_mode(GstAmlV4l2Object *v4l2object)
6130{
6131 if (v4l2object->stream_mode)
6132 {
6133 if (gst_aml_v4l2_set_control(v4l2object, AML_V4L2_SET_STREAM_MODE))
6134 {
6135 GST_DEBUG_OBJECT(v4l2object->dbg_obj, "AML_V4L2_SET_STREAM_MODE set succ");
6136 return TRUE;
6137 }
6138 else
6139 {
6140 GST_ERROR_OBJECT(v4l2object->dbg_obj, "AML_V4L2_SET_STREAM_MODE set fail");
6141 return FALSE;
6142 }
6143 }
6144 else
6145 {
6146 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 +08006147 return TRUE;
6148 }
xuesong.jiangc5dac0f2023-02-01 14:42:24 +08006149}
6150
6151gint gst_aml_v4l2_object_get_outstanding_capture_buf_num(GstAmlV4l2Object *obj)
6152{
6153 gint ret = 0;
6154 gint count = 0;
6155
6156 if (obj->old_other_pool)
6157 {
6158 count = gst_buffer_pool_get_outstanding_num(obj->old_other_pool);
6159 if (count)
6160 {
6161 ret += count;
6162 }
6163 else
6164 {
6165 gst_object_unref(obj->old_other_pool);
6166 obj->old_other_pool = NULL;
6167 }
6168 }
6169
6170 count = 0;
6171 if (obj->old_old_other_pool)
6172 {
6173 count = gst_buffer_pool_get_outstanding_num(obj->old_old_other_pool);
6174 if (count)
6175 {
6176 ret += count;
6177 }
6178 else
6179 {
6180 gst_object_unref(obj->old_old_other_pool);
6181 obj->old_old_other_pool = NULL;
6182 }
6183 }
6184
6185 return ret;
xuesong.jiangae1548e2022-05-06 16:38:46 +08006186}