2 * Video capture interface for Linux version 2
4 * A generic framework to process V4L2 ioctl commands.
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version
9 * 2 of the License, or (at your option) any later version.
11 * Authors: Alan Cox, <alan@lxorguk.ukuu.org.uk> (version 1)
12 * Mauro Carvalho Chehab <mchehab@infradead.org> (version 2)
15 #include <linux/module.h>
16 #include <linux/slab.h>
17 #include <linux/types.h>
18 #include <linux/kernel.h>
19 #include <linux/version.h>
21 #include <linux/videodev2.h>
23 #include <media/v4l2-common.h>
24 #include <media/v4l2-ioctl.h>
25 #include <media/v4l2-ctrls.h>
26 #include <media/v4l2-fh.h>
27 #include <media/v4l2-event.h>
28 #include <media/v4l2-device.h>
29 #include <media/v4l2-chip-ident.h>
30 #include <media/videobuf2-core.h>
32 /* Zero out the end of the struct pointed to by p. Everything after, but
33 * not including, the specified field is cleared. */
34 #define CLEAR_AFTER_FIELD(p, field) \
35 memset((u8 *)(p) + offsetof(typeof(*(p)), field) + sizeof((p)->field), \
36 0, sizeof(*(p)) - offsetof(typeof(*(p)), field) - sizeof((p)->field))
43 static const struct std_descr standards
[] = {
44 { V4L2_STD_NTSC
, "NTSC" },
45 { V4L2_STD_NTSC_M
, "NTSC-M" },
46 { V4L2_STD_NTSC_M_JP
, "NTSC-M-JP" },
47 { V4L2_STD_NTSC_M_KR
, "NTSC-M-KR" },
48 { V4L2_STD_NTSC_443
, "NTSC-443" },
49 { V4L2_STD_PAL
, "PAL" },
50 { V4L2_STD_PAL_BG
, "PAL-BG" },
51 { V4L2_STD_PAL_B
, "PAL-B" },
52 { V4L2_STD_PAL_B1
, "PAL-B1" },
53 { V4L2_STD_PAL_G
, "PAL-G" },
54 { V4L2_STD_PAL_H
, "PAL-H" },
55 { V4L2_STD_PAL_I
, "PAL-I" },
56 { V4L2_STD_PAL_DK
, "PAL-DK" },
57 { V4L2_STD_PAL_D
, "PAL-D" },
58 { V4L2_STD_PAL_D1
, "PAL-D1" },
59 { V4L2_STD_PAL_K
, "PAL-K" },
60 { V4L2_STD_PAL_M
, "PAL-M" },
61 { V4L2_STD_PAL_N
, "PAL-N" },
62 { V4L2_STD_PAL_Nc
, "PAL-Nc" },
63 { V4L2_STD_PAL_60
, "PAL-60" },
64 { V4L2_STD_SECAM
, "SECAM" },
65 { V4L2_STD_SECAM_B
, "SECAM-B" },
66 { V4L2_STD_SECAM_G
, "SECAM-G" },
67 { V4L2_STD_SECAM_H
, "SECAM-H" },
68 { V4L2_STD_SECAM_DK
, "SECAM-DK" },
69 { V4L2_STD_SECAM_D
, "SECAM-D" },
70 { V4L2_STD_SECAM_K
, "SECAM-K" },
71 { V4L2_STD_SECAM_K1
, "SECAM-K1" },
72 { V4L2_STD_SECAM_L
, "SECAM-L" },
73 { V4L2_STD_SECAM_LC
, "SECAM-Lc" },
77 /* video4linux standard ID conversion to standard name
79 const char *v4l2_norm_to_name(v4l2_std_id id
)
84 /* HACK: ppc32 architecture doesn't have __ucmpdi2 function to handle
85 64 bit comparations. So, on that architecture, with some gcc
86 variants, compilation fails. Currently, the max value is 30bit wide.
90 for (i
= 0; standards
[i
].std
; i
++)
91 if (myid
== standards
[i
].std
)
93 return standards
[i
].descr
;
95 EXPORT_SYMBOL(v4l2_norm_to_name
);
97 /* Returns frame period for the given standard */
98 void v4l2_video_std_frame_period(int id
, struct v4l2_fract
*frameperiod
)
100 if (id
& V4L2_STD_525_60
) {
101 frameperiod
->numerator
= 1001;
102 frameperiod
->denominator
= 30000;
104 frameperiod
->numerator
= 1;
105 frameperiod
->denominator
= 25;
108 EXPORT_SYMBOL(v4l2_video_std_frame_period
);
110 /* Fill in the fields of a v4l2_standard structure according to the
111 'id' and 'transmission' parameters. Returns negative on error. */
112 int v4l2_video_std_construct(struct v4l2_standard
*vs
,
113 int id
, const char *name
)
116 v4l2_video_std_frame_period(id
, &vs
->frameperiod
);
117 vs
->framelines
= (id
& V4L2_STD_525_60
) ? 525 : 625;
118 strlcpy(vs
->name
, name
, sizeof(vs
->name
));
121 EXPORT_SYMBOL(v4l2_video_std_construct
);
123 /* ----------------------------------------------------------------- */
124 /* some arrays for pretty-printing debug messages of enum types */
126 const char *v4l2_field_names
[] = {
127 [V4L2_FIELD_ANY
] = "any",
128 [V4L2_FIELD_NONE
] = "none",
129 [V4L2_FIELD_TOP
] = "top",
130 [V4L2_FIELD_BOTTOM
] = "bottom",
131 [V4L2_FIELD_INTERLACED
] = "interlaced",
132 [V4L2_FIELD_SEQ_TB
] = "seq-tb",
133 [V4L2_FIELD_SEQ_BT
] = "seq-bt",
134 [V4L2_FIELD_ALTERNATE
] = "alternate",
135 [V4L2_FIELD_INTERLACED_TB
] = "interlaced-tb",
136 [V4L2_FIELD_INTERLACED_BT
] = "interlaced-bt",
138 EXPORT_SYMBOL(v4l2_field_names
);
140 const char *v4l2_type_names
[] = {
141 [V4L2_BUF_TYPE_VIDEO_CAPTURE
] = "vid-cap",
142 [V4L2_BUF_TYPE_VIDEO_OVERLAY
] = "vid-overlay",
143 [V4L2_BUF_TYPE_VIDEO_OUTPUT
] = "vid-out",
144 [V4L2_BUF_TYPE_VBI_CAPTURE
] = "vbi-cap",
145 [V4L2_BUF_TYPE_VBI_OUTPUT
] = "vbi-out",
146 [V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
] = "sliced-vbi-cap",
147 [V4L2_BUF_TYPE_SLICED_VBI_OUTPUT
] = "sliced-vbi-out",
148 [V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
] = "vid-out-overlay",
149 [V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE
] = "vid-cap-mplane",
150 [V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE
] = "vid-out-mplane",
152 EXPORT_SYMBOL(v4l2_type_names
);
154 static const char *v4l2_memory_names
[] = {
155 [V4L2_MEMORY_MMAP
] = "mmap",
156 [V4L2_MEMORY_USERPTR
] = "userptr",
157 [V4L2_MEMORY_OVERLAY
] = "overlay",
158 [V4L2_MEMORY_DMABUF
] = "dmabuf",
161 #define prt_names(a, arr) (((unsigned)(a)) < ARRAY_SIZE(arr) ? arr[a] : "unknown")
163 /* ------------------------------------------------------------------ */
164 /* debug help functions */
166 static void v4l_print_querycap(const void *arg
, bool write_only
)
168 const struct v4l2_capability
*p
= arg
;
170 pr_cont("driver=%s, card=%s, bus=%s, version=0x%08x, "
171 "capabilities=0x%08x, device_caps=0x%08x\n",
172 p
->driver
, p
->card
, p
->bus_info
,
173 p
->version
, p
->capabilities
, p
->device_caps
);
176 static void v4l_print_enuminput(const void *arg
, bool write_only
)
178 const struct v4l2_input
*p
= arg
;
180 pr_cont("index=%u, name=%s, type=%u, audioset=0x%x, tuner=%u, "
181 "std=0x%08Lx, status=0x%x, capabilities=0x%x\n",
182 p
->index
, p
->name
, p
->type
, p
->audioset
, p
->tuner
,
183 (unsigned long long)p
->std
, p
->status
, p
->capabilities
);
186 static void v4l_print_enumoutput(const void *arg
, bool write_only
)
188 const struct v4l2_output
*p
= arg
;
190 pr_cont("index=%u, name=%s, type=%u, audioset=0x%x, "
191 "modulator=%u, std=0x%08Lx, capabilities=0x%x\n",
192 p
->index
, p
->name
, p
->type
, p
->audioset
, p
->modulator
,
193 (unsigned long long)p
->std
, p
->capabilities
);
196 static void v4l_print_audio(const void *arg
, bool write_only
)
198 const struct v4l2_audio
*p
= arg
;
201 pr_cont("index=%u, mode=0x%x\n", p
->index
, p
->mode
);
203 pr_cont("index=%u, name=%s, capability=0x%x, mode=0x%x\n",
204 p
->index
, p
->name
, p
->capability
, p
->mode
);
207 static void v4l_print_audioout(const void *arg
, bool write_only
)
209 const struct v4l2_audioout
*p
= arg
;
212 pr_cont("index=%u\n", p
->index
);
214 pr_cont("index=%u, name=%s, capability=0x%x, mode=0x%x\n",
215 p
->index
, p
->name
, p
->capability
, p
->mode
);
218 static void v4l_print_fmtdesc(const void *arg
, bool write_only
)
220 const struct v4l2_fmtdesc
*p
= arg
;
222 pr_cont("index=%u, type=%s, flags=0x%x, pixelformat=%c%c%c%c, description='%s'\n",
223 p
->index
, prt_names(p
->type
, v4l2_type_names
),
224 p
->flags
, (p
->pixelformat
& 0xff),
225 (p
->pixelformat
>> 8) & 0xff,
226 (p
->pixelformat
>> 16) & 0xff,
227 (p
->pixelformat
>> 24) & 0xff,
231 static void v4l_print_format(const void *arg
, bool write_only
)
233 const struct v4l2_format
*p
= arg
;
234 const struct v4l2_pix_format
*pix
;
235 const struct v4l2_pix_format_mplane
*mp
;
236 const struct v4l2_vbi_format
*vbi
;
237 const struct v4l2_sliced_vbi_format
*sliced
;
238 const struct v4l2_window
*win
;
239 const struct v4l2_clip
*clip
;
242 pr_cont("type=%s", prt_names(p
->type
, v4l2_type_names
));
244 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
245 case V4L2_BUF_TYPE_VIDEO_OUTPUT
:
247 pr_cont(", width=%u, height=%u, "
248 "pixelformat=%c%c%c%c, field=%s, "
249 "bytesperline=%u sizeimage=%u, colorspace=%d\n",
250 pix
->width
, pix
->height
,
251 (pix
->pixelformat
& 0xff),
252 (pix
->pixelformat
>> 8) & 0xff,
253 (pix
->pixelformat
>> 16) & 0xff,
254 (pix
->pixelformat
>> 24) & 0xff,
255 prt_names(pix
->field
, v4l2_field_names
),
256 pix
->bytesperline
, pix
->sizeimage
,
259 case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE
:
260 case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE
:
262 pr_cont(", width=%u, height=%u, "
263 "format=%c%c%c%c, field=%s, "
264 "colorspace=%d, num_planes=%u\n",
265 mp
->width
, mp
->height
,
266 (mp
->pixelformat
& 0xff),
267 (mp
->pixelformat
>> 8) & 0xff,
268 (mp
->pixelformat
>> 16) & 0xff,
269 (mp
->pixelformat
>> 24) & 0xff,
270 prt_names(mp
->field
, v4l2_field_names
),
271 mp
->colorspace
, mp
->num_planes
);
272 for (i
= 0; i
< mp
->num_planes
; i
++)
273 printk(KERN_DEBUG
"plane %u: bytesperline=%u sizeimage=%u\n", i
,
274 mp
->plane_fmt
[i
].bytesperline
,
275 mp
->plane_fmt
[i
].sizeimage
);
277 case V4L2_BUF_TYPE_VIDEO_OVERLAY
:
278 case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
:
280 pr_cont(", wxh=%dx%d, x,y=%d,%d, field=%s, "
281 "chromakey=0x%08x, bitmap=%p, "
282 "global_alpha=0x%02x\n",
283 win
->w
.width
, win
->w
.height
,
284 win
->w
.left
, win
->w
.top
,
285 prt_names(win
->field
, v4l2_field_names
),
286 win
->chromakey
, win
->bitmap
, win
->global_alpha
);
288 for (i
= 0; i
< win
->clipcount
; i
++) {
289 printk(KERN_DEBUG
"clip %u: wxh=%dx%d, x,y=%d,%d\n",
290 i
, clip
->c
.width
, clip
->c
.height
,
291 clip
->c
.left
, clip
->c
.top
);
295 case V4L2_BUF_TYPE_VBI_CAPTURE
:
296 case V4L2_BUF_TYPE_VBI_OUTPUT
:
298 pr_cont(", sampling_rate=%u, offset=%u, samples_per_line=%u, "
299 "sample_format=%c%c%c%c, start=%u,%u, count=%u,%u\n",
300 vbi
->sampling_rate
, vbi
->offset
,
301 vbi
->samples_per_line
,
302 (vbi
->sample_format
& 0xff),
303 (vbi
->sample_format
>> 8) & 0xff,
304 (vbi
->sample_format
>> 16) & 0xff,
305 (vbi
->sample_format
>> 24) & 0xff,
306 vbi
->start
[0], vbi
->start
[1],
307 vbi
->count
[0], vbi
->count
[1]);
309 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
:
310 case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT
:
311 sliced
= &p
->fmt
.sliced
;
312 pr_cont(", service_set=0x%08x, io_size=%d\n",
313 sliced
->service_set
, sliced
->io_size
);
314 for (i
= 0; i
< 24; i
++)
315 printk(KERN_DEBUG
"line[%02u]=0x%04x, 0x%04x\n", i
,
316 sliced
->service_lines
[0][i
],
317 sliced
->service_lines
[1][i
]);
322 static void v4l_print_framebuffer(const void *arg
, bool write_only
)
324 const struct v4l2_framebuffer
*p
= arg
;
326 pr_cont("capability=0x%x, flags=0x%x, base=0x%p, width=%u, "
327 "height=%u, pixelformat=%c%c%c%c, "
328 "bytesperline=%u sizeimage=%u, colorspace=%d\n",
329 p
->capability
, p
->flags
, p
->base
,
330 p
->fmt
.width
, p
->fmt
.height
,
331 (p
->fmt
.pixelformat
& 0xff),
332 (p
->fmt
.pixelformat
>> 8) & 0xff,
333 (p
->fmt
.pixelformat
>> 16) & 0xff,
334 (p
->fmt
.pixelformat
>> 24) & 0xff,
335 p
->fmt
.bytesperline
, p
->fmt
.sizeimage
,
339 static void v4l_print_buftype(const void *arg
, bool write_only
)
341 pr_cont("type=%s\n", prt_names(*(u32
*)arg
, v4l2_type_names
));
344 static void v4l_print_modulator(const void *arg
, bool write_only
)
346 const struct v4l2_modulator
*p
= arg
;
349 pr_cont("index=%u, txsubchans=0x%x", p
->index
, p
->txsubchans
);
351 pr_cont("index=%u, name=%s, capability=0x%x, "
352 "rangelow=%u, rangehigh=%u, txsubchans=0x%x\n",
353 p
->index
, p
->name
, p
->capability
,
354 p
->rangelow
, p
->rangehigh
, p
->txsubchans
);
357 static void v4l_print_tuner(const void *arg
, bool write_only
)
359 const struct v4l2_tuner
*p
= arg
;
362 pr_cont("index=%u, audmode=%u\n", p
->index
, p
->audmode
);
364 pr_cont("index=%u, name=%s, type=%u, capability=0x%x, "
365 "rangelow=%u, rangehigh=%u, signal=%u, afc=%d, "
366 "rxsubchans=0x%x, audmode=%u\n",
367 p
->index
, p
->name
, p
->type
,
368 p
->capability
, p
->rangelow
,
369 p
->rangehigh
, p
->signal
, p
->afc
,
370 p
->rxsubchans
, p
->audmode
);
373 static void v4l_print_frequency(const void *arg
, bool write_only
)
375 const struct v4l2_frequency
*p
= arg
;
377 pr_cont("tuner=%u, type=%u, frequency=%u\n",
378 p
->tuner
, p
->type
, p
->frequency
);
381 static void v4l_print_standard(const void *arg
, bool write_only
)
383 const struct v4l2_standard
*p
= arg
;
385 pr_cont("index=%u, id=0x%Lx, name=%s, fps=%u/%u, "
386 "framelines=%u\n", p
->index
,
387 (unsigned long long)p
->id
, p
->name
,
388 p
->frameperiod
.numerator
,
389 p
->frameperiod
.denominator
,
393 static void v4l_print_std(const void *arg
, bool write_only
)
395 pr_cont("std=0x%08Lx\n", *(const long long unsigned *)arg
);
398 static void v4l_print_hw_freq_seek(const void *arg
, bool write_only
)
400 const struct v4l2_hw_freq_seek
*p
= arg
;
402 pr_cont("tuner=%u, type=%u, seek_upward=%u, wrap_around=%u, spacing=%u, "
403 "rangelow=%u, rangehigh=%u\n",
404 p
->tuner
, p
->type
, p
->seek_upward
, p
->wrap_around
, p
->spacing
,
405 p
->rangelow
, p
->rangehigh
);
408 static void v4l_print_requestbuffers(const void *arg
, bool write_only
)
410 const struct v4l2_requestbuffers
*p
= arg
;
412 pr_cont("count=%d, type=%s, memory=%s\n",
414 prt_names(p
->type
, v4l2_type_names
),
415 prt_names(p
->memory
, v4l2_memory_names
));
418 static void v4l_print_buffer(const void *arg
, bool write_only
)
420 const struct v4l2_buffer
*p
= arg
;
421 const struct v4l2_timecode
*tc
= &p
->timecode
;
422 const struct v4l2_plane
*plane
;
425 pr_cont("%02ld:%02d:%02d.%08ld index=%d, type=%s, "
426 "flags=0x%08x, field=%s, sequence=%d, memory=%s",
427 p
->timestamp
.tv_sec
/ 3600,
428 (int)(p
->timestamp
.tv_sec
/ 60) % 60,
429 (int)(p
->timestamp
.tv_sec
% 60),
430 (long)p
->timestamp
.tv_usec
,
432 prt_names(p
->type
, v4l2_type_names
),
433 p
->flags
, prt_names(p
->field
, v4l2_field_names
),
434 p
->sequence
, prt_names(p
->memory
, v4l2_memory_names
));
436 if (V4L2_TYPE_IS_MULTIPLANAR(p
->type
) && p
->m
.planes
) {
438 for (i
= 0; i
< p
->length
; ++i
) {
439 plane
= &p
->m
.planes
[i
];
441 "plane %d: bytesused=%d, data_offset=0x%08x "
442 "offset/userptr=0x%lx, length=%d\n",
443 i
, plane
->bytesused
, plane
->data_offset
,
444 plane
->m
.userptr
, plane
->length
);
447 pr_cont("bytesused=%d, offset/userptr=0x%lx, length=%d\n",
448 p
->bytesused
, p
->m
.userptr
, p
->length
);
451 printk(KERN_DEBUG
"timecode=%02d:%02d:%02d type=%d, "
452 "flags=0x%08x, frames=%d, userbits=0x%08x\n",
453 tc
->hours
, tc
->minutes
, tc
->seconds
,
454 tc
->type
, tc
->flags
, tc
->frames
, *(__u32
*)tc
->userbits
);
457 static void v4l_print_exportbuffer(const void *arg
, bool write_only
)
459 const struct v4l2_exportbuffer
*p
= arg
;
461 pr_cont("fd=%d, type=%s, index=%u, plane=%u, flags=0x%08x\n",
462 p
->fd
, prt_names(p
->type
, v4l2_type_names
),
463 p
->index
, p
->plane
, p
->flags
);
466 static void v4l_print_create_buffers(const void *arg
, bool write_only
)
468 const struct v4l2_create_buffers
*p
= arg
;
470 pr_cont("index=%d, count=%d, memory=%s, ",
472 prt_names(p
->memory
, v4l2_memory_names
));
473 v4l_print_format(&p
->format
, write_only
);
476 static void v4l_print_streamparm(const void *arg
, bool write_only
)
478 const struct v4l2_streamparm
*p
= arg
;
480 pr_cont("type=%s", prt_names(p
->type
, v4l2_type_names
));
482 if (p
->type
== V4L2_BUF_TYPE_VIDEO_CAPTURE
||
483 p
->type
== V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE
) {
484 const struct v4l2_captureparm
*c
= &p
->parm
.capture
;
486 pr_cont(", capability=0x%x, capturemode=0x%x, timeperframe=%d/%d, "
487 "extendedmode=%d, readbuffers=%d\n",
488 c
->capability
, c
->capturemode
,
489 c
->timeperframe
.numerator
, c
->timeperframe
.denominator
,
490 c
->extendedmode
, c
->readbuffers
);
491 } else if (p
->type
== V4L2_BUF_TYPE_VIDEO_OUTPUT
||
492 p
->type
== V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE
) {
493 const struct v4l2_outputparm
*c
= &p
->parm
.output
;
495 pr_cont(", capability=0x%x, outputmode=0x%x, timeperframe=%d/%d, "
496 "extendedmode=%d, writebuffers=%d\n",
497 c
->capability
, c
->outputmode
,
498 c
->timeperframe
.numerator
, c
->timeperframe
.denominator
,
499 c
->extendedmode
, c
->writebuffers
);
503 static void v4l_print_queryctrl(const void *arg
, bool write_only
)
505 const struct v4l2_queryctrl
*p
= arg
;
507 pr_cont("id=0x%x, type=%d, name=%s, min/max=%d/%d, "
508 "step=%d, default=%d, flags=0x%08x\n",
509 p
->id
, p
->type
, p
->name
,
510 p
->minimum
, p
->maximum
,
511 p
->step
, p
->default_value
, p
->flags
);
514 static void v4l_print_querymenu(const void *arg
, bool write_only
)
516 const struct v4l2_querymenu
*p
= arg
;
518 pr_cont("id=0x%x, index=%d\n", p
->id
, p
->index
);
521 static void v4l_print_control(const void *arg
, bool write_only
)
523 const struct v4l2_control
*p
= arg
;
525 pr_cont("id=0x%x, value=%d\n", p
->id
, p
->value
);
528 static void v4l_print_ext_controls(const void *arg
, bool write_only
)
530 const struct v4l2_ext_controls
*p
= arg
;
533 pr_cont("class=0x%x, count=%d, error_idx=%d",
534 p
->ctrl_class
, p
->count
, p
->error_idx
);
535 for (i
= 0; i
< p
->count
; i
++) {
536 if (p
->controls
[i
].size
)
537 pr_cont(", id/val=0x%x/0x%x",
538 p
->controls
[i
].id
, p
->controls
[i
].value
);
540 pr_cont(", id/size=0x%x/%u",
541 p
->controls
[i
].id
, p
->controls
[i
].size
);
546 static void v4l_print_cropcap(const void *arg
, bool write_only
)
548 const struct v4l2_cropcap
*p
= arg
;
550 pr_cont("type=%s, bounds wxh=%dx%d, x,y=%d,%d, "
551 "defrect wxh=%dx%d, x,y=%d,%d\n, "
552 "pixelaspect %d/%d\n",
553 prt_names(p
->type
, v4l2_type_names
),
554 p
->bounds
.width
, p
->bounds
.height
,
555 p
->bounds
.left
, p
->bounds
.top
,
556 p
->defrect
.width
, p
->defrect
.height
,
557 p
->defrect
.left
, p
->defrect
.top
,
558 p
->pixelaspect
.numerator
, p
->pixelaspect
.denominator
);
561 static void v4l_print_crop(const void *arg
, bool write_only
)
563 const struct v4l2_crop
*p
= arg
;
565 pr_cont("type=%s, wxh=%dx%d, x,y=%d,%d\n",
566 prt_names(p
->type
, v4l2_type_names
),
567 p
->c
.width
, p
->c
.height
,
568 p
->c
.left
, p
->c
.top
);
571 static void v4l_print_selection(const void *arg
, bool write_only
)
573 const struct v4l2_selection
*p
= arg
;
575 pr_cont("type=%s, target=%d, flags=0x%x, wxh=%dx%d, x,y=%d,%d\n",
576 prt_names(p
->type
, v4l2_type_names
),
578 p
->r
.width
, p
->r
.height
, p
->r
.left
, p
->r
.top
);
581 static void v4l_print_jpegcompression(const void *arg
, bool write_only
)
583 const struct v4l2_jpegcompression
*p
= arg
;
585 pr_cont("quality=%d, APPn=%d, APP_len=%d, "
586 "COM_len=%d, jpeg_markers=0x%x\n",
587 p
->quality
, p
->APPn
, p
->APP_len
,
588 p
->COM_len
, p
->jpeg_markers
);
591 static void v4l_print_enc_idx(const void *arg
, bool write_only
)
593 const struct v4l2_enc_idx
*p
= arg
;
595 pr_cont("entries=%d, entries_cap=%d\n",
596 p
->entries
, p
->entries_cap
);
599 static void v4l_print_encoder_cmd(const void *arg
, bool write_only
)
601 const struct v4l2_encoder_cmd
*p
= arg
;
603 pr_cont("cmd=%d, flags=0x%x\n",
607 static void v4l_print_decoder_cmd(const void *arg
, bool write_only
)
609 const struct v4l2_decoder_cmd
*p
= arg
;
611 pr_cont("cmd=%d, flags=0x%x\n", p
->cmd
, p
->flags
);
613 if (p
->cmd
== V4L2_DEC_CMD_START
)
614 pr_info("speed=%d, format=%u\n",
615 p
->start
.speed
, p
->start
.format
);
616 else if (p
->cmd
== V4L2_DEC_CMD_STOP
)
617 pr_info("pts=%llu\n", p
->stop
.pts
);
620 static void v4l_print_dbg_chip_ident(const void *arg
, bool write_only
)
622 const struct v4l2_dbg_chip_ident
*p
= arg
;
624 pr_cont("type=%u, ", p
->match
.type
);
625 if (p
->match
.type
== V4L2_CHIP_MATCH_I2C_DRIVER
)
626 pr_cont("name=%s, ", p
->match
.name
);
628 pr_cont("addr=%u, ", p
->match
.addr
);
629 pr_cont("chip_ident=%u, revision=0x%x\n",
630 p
->ident
, p
->revision
);
633 static void v4l_print_dbg_register(const void *arg
, bool write_only
)
635 const struct v4l2_dbg_register
*p
= arg
;
637 pr_cont("type=%u, ", p
->match
.type
);
638 if (p
->match
.type
== V4L2_CHIP_MATCH_I2C_DRIVER
)
639 pr_cont("name=%s, ", p
->match
.name
);
641 pr_cont("addr=%u, ", p
->match
.addr
);
642 pr_cont("reg=0x%llx, val=0x%llx\n",
646 static void v4l_print_dv_enum_presets(const void *arg
, bool write_only
)
648 const struct v4l2_dv_enum_preset
*p
= arg
;
650 pr_cont("index=%u, preset=%u, name=%s, width=%u, height=%u\n",
651 p
->index
, p
->preset
, p
->name
, p
->width
, p
->height
);
654 static void v4l_print_dv_preset(const void *arg
, bool write_only
)
656 const struct v4l2_dv_preset
*p
= arg
;
658 pr_cont("preset=%u\n", p
->preset
);
661 static void v4l_print_dv_timings(const void *arg
, bool write_only
)
663 const struct v4l2_dv_timings
*p
= arg
;
666 case V4L2_DV_BT_656_1120
:
667 pr_cont("type=bt-656/1120, interlaced=%u, "
669 "width=%u, height=%u, polarities=0x%x, "
670 "hfrontporch=%u, hsync=%u, "
671 "hbackporch=%u, vfrontporch=%u, "
672 "vsync=%u, vbackporch=%u, "
673 "il_vfrontporch=%u, il_vsync=%u, "
674 "il_vbackporch=%u, standards=0x%x, flags=0x%x\n",
675 p
->bt
.interlaced
, p
->bt
.pixelclock
,
676 p
->bt
.width
, p
->bt
.height
,
677 p
->bt
.polarities
, p
->bt
.hfrontporch
,
678 p
->bt
.hsync
, p
->bt
.hbackporch
,
679 p
->bt
.vfrontporch
, p
->bt
.vsync
,
680 p
->bt
.vbackporch
, p
->bt
.il_vfrontporch
,
681 p
->bt
.il_vsync
, p
->bt
.il_vbackporch
,
682 p
->bt
.standards
, p
->bt
.flags
);
685 pr_cont("type=%d\n", p
->type
);
690 static void v4l_print_enum_dv_timings(const void *arg
, bool write_only
)
692 const struct v4l2_enum_dv_timings
*p
= arg
;
694 pr_cont("index=%u, ", p
->index
);
695 v4l_print_dv_timings(&p
->timings
, write_only
);
698 static void v4l_print_dv_timings_cap(const void *arg
, bool write_only
)
700 const struct v4l2_dv_timings_cap
*p
= arg
;
703 case V4L2_DV_BT_656_1120
:
704 pr_cont("type=bt-656/1120, width=%u-%u, height=%u-%u, "
705 "pixelclock=%llu-%llu, standards=0x%x, capabilities=0x%x\n",
706 p
->bt
.min_width
, p
->bt
.max_width
,
707 p
->bt
.min_height
, p
->bt
.max_height
,
708 p
->bt
.min_pixelclock
, p
->bt
.max_pixelclock
,
709 p
->bt
.standards
, p
->bt
.capabilities
);
712 pr_cont("type=%u\n", p
->type
);
717 static void v4l_print_frmsizeenum(const void *arg
, bool write_only
)
719 const struct v4l2_frmsizeenum
*p
= arg
;
721 pr_cont("index=%u, pixelformat=%c%c%c%c, type=%u",
723 (p
->pixel_format
& 0xff),
724 (p
->pixel_format
>> 8) & 0xff,
725 (p
->pixel_format
>> 16) & 0xff,
726 (p
->pixel_format
>> 24) & 0xff,
729 case V4L2_FRMSIZE_TYPE_DISCRETE
:
730 pr_cont(" wxh=%ux%u\n",
731 p
->discrete
.width
, p
->discrete
.height
);
733 case V4L2_FRMSIZE_TYPE_STEPWISE
:
734 pr_cont(" min=%ux%u, max=%ux%u, step=%ux%u\n",
735 p
->stepwise
.min_width
, p
->stepwise
.min_height
,
736 p
->stepwise
.step_width
, p
->stepwise
.step_height
,
737 p
->stepwise
.max_width
, p
->stepwise
.max_height
);
739 case V4L2_FRMSIZE_TYPE_CONTINUOUS
:
747 static void v4l_print_frmivalenum(const void *arg
, bool write_only
)
749 const struct v4l2_frmivalenum
*p
= arg
;
751 pr_cont("index=%u, pixelformat=%c%c%c%c, wxh=%ux%u, type=%u",
753 (p
->pixel_format
& 0xff),
754 (p
->pixel_format
>> 8) & 0xff,
755 (p
->pixel_format
>> 16) & 0xff,
756 (p
->pixel_format
>> 24) & 0xff,
757 p
->width
, p
->height
, p
->type
);
759 case V4L2_FRMIVAL_TYPE_DISCRETE
:
760 pr_cont(" fps=%d/%d\n",
761 p
->discrete
.numerator
,
762 p
->discrete
.denominator
);
764 case V4L2_FRMIVAL_TYPE_STEPWISE
:
765 pr_cont(" min=%d/%d, max=%d/%d, step=%d/%d\n",
766 p
->stepwise
.min
.numerator
,
767 p
->stepwise
.min
.denominator
,
768 p
->stepwise
.max
.numerator
,
769 p
->stepwise
.max
.denominator
,
770 p
->stepwise
.step
.numerator
,
771 p
->stepwise
.step
.denominator
);
773 case V4L2_FRMIVAL_TYPE_CONTINUOUS
:
781 static void v4l_print_event(const void *arg
, bool write_only
)
783 const struct v4l2_event
*p
= arg
;
784 const struct v4l2_event_ctrl
*c
;
786 pr_cont("type=0x%x, pending=%u, sequence=%u, id=%u, "
787 "timestamp=%lu.%9.9lu\n",
788 p
->type
, p
->pending
, p
->sequence
, p
->id
,
789 p
->timestamp
.tv_sec
, p
->timestamp
.tv_nsec
);
791 case V4L2_EVENT_VSYNC
:
792 printk(KERN_DEBUG
"field=%s\n",
793 prt_names(p
->u
.vsync
.field
, v4l2_field_names
));
795 case V4L2_EVENT_CTRL
:
797 printk(KERN_DEBUG
"changes=0x%x, type=%u, ",
798 c
->changes
, c
->type
);
799 if (c
->type
== V4L2_CTRL_TYPE_INTEGER64
)
800 pr_cont("value64=%lld, ", c
->value64
);
802 pr_cont("value=%d, ", c
->value
);
803 pr_cont("flags=0x%x, minimum=%d, maximum=%d, step=%d,"
804 " default_value=%d\n",
805 c
->flags
, c
->minimum
, c
->maximum
,
806 c
->step
, c
->default_value
);
808 case V4L2_EVENT_FRAME_SYNC
:
809 pr_cont("frame_sequence=%u\n",
810 p
->u
.frame_sync
.frame_sequence
);
815 static void v4l_print_event_subscription(const void *arg
, bool write_only
)
817 const struct v4l2_event_subscription
*p
= arg
;
819 pr_cont("type=0x%x, id=0x%x, flags=0x%x\n",
820 p
->type
, p
->id
, p
->flags
);
823 static void v4l_print_sliced_vbi_cap(const void *arg
, bool write_only
)
825 const struct v4l2_sliced_vbi_cap
*p
= arg
;
828 pr_cont("type=%s, service_set=0x%08x\n",
829 prt_names(p
->type
, v4l2_type_names
), p
->service_set
);
830 for (i
= 0; i
< 24; i
++)
831 printk(KERN_DEBUG
"line[%02u]=0x%04x, 0x%04x\n", i
,
832 p
->service_lines
[0][i
],
833 p
->service_lines
[1][i
]);
836 static void v4l_print_freq_band(const void *arg
, bool write_only
)
838 const struct v4l2_frequency_band
*p
= arg
;
840 pr_cont("tuner=%u, type=%u, index=%u, capability=0x%x, "
841 "rangelow=%u, rangehigh=%u, modulation=0x%x\n",
842 p
->tuner
, p
->type
, p
->index
,
843 p
->capability
, p
->rangelow
,
844 p
->rangehigh
, p
->modulation
);
847 static void v4l_print_u32(const void *arg
, bool write_only
)
849 pr_cont("value=%u\n", *(const u32
*)arg
);
852 static void v4l_print_newline(const void *arg
, bool write_only
)
857 static void v4l_print_default(const void *arg
, bool write_only
)
859 pr_cont("driver-specific ioctl\n");
862 static int check_ext_ctrls(struct v4l2_ext_controls
*c
, int allow_priv
)
866 /* zero the reserved fields */
867 c
->reserved
[0] = c
->reserved
[1] = 0;
868 for (i
= 0; i
< c
->count
; i
++)
869 c
->controls
[i
].reserved2
[0] = 0;
871 /* V4L2_CID_PRIVATE_BASE cannot be used as control class
872 when using extended controls.
873 Only when passed in through VIDIOC_G_CTRL and VIDIOC_S_CTRL
874 is it allowed for backwards compatibility.
876 if (!allow_priv
&& c
->ctrl_class
== V4L2_CID_PRIVATE_BASE
)
878 /* Check that all controls are from the same control class. */
879 for (i
= 0; i
< c
->count
; i
++) {
880 if (V4L2_CTRL_ID2CLASS(c
->controls
[i
].id
) != c
->ctrl_class
) {
888 static int check_fmt(struct file
*file
, enum v4l2_buf_type type
)
890 struct video_device
*vfd
= video_devdata(file
);
891 const struct v4l2_ioctl_ops
*ops
= vfd
->ioctl_ops
;
892 bool is_vid
= vfd
->vfl_type
== VFL_TYPE_GRABBER
;
893 bool is_vbi
= vfd
->vfl_type
== VFL_TYPE_VBI
;
894 bool is_rx
= vfd
->vfl_dir
!= VFL_DIR_TX
;
895 bool is_tx
= vfd
->vfl_dir
!= VFL_DIR_RX
;
901 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
902 if (is_vid
&& is_rx
&&
903 (ops
->vidioc_g_fmt_vid_cap
|| ops
->vidioc_g_fmt_vid_cap_mplane
))
906 case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE
:
907 if (is_vid
&& is_rx
&& ops
->vidioc_g_fmt_vid_cap_mplane
)
910 case V4L2_BUF_TYPE_VIDEO_OVERLAY
:
911 if (is_vid
&& is_rx
&& ops
->vidioc_g_fmt_vid_overlay
)
914 case V4L2_BUF_TYPE_VIDEO_OUTPUT
:
915 if (is_vid
&& is_tx
&&
916 (ops
->vidioc_g_fmt_vid_out
|| ops
->vidioc_g_fmt_vid_out_mplane
))
919 case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE
:
920 if (is_vid
&& is_tx
&& ops
->vidioc_g_fmt_vid_out_mplane
)
923 case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
:
924 if (is_vid
&& is_tx
&& ops
->vidioc_g_fmt_vid_out_overlay
)
927 case V4L2_BUF_TYPE_VBI_CAPTURE
:
928 if (is_vbi
&& is_rx
&& ops
->vidioc_g_fmt_vbi_cap
)
931 case V4L2_BUF_TYPE_VBI_OUTPUT
:
932 if (is_vbi
&& is_tx
&& ops
->vidioc_g_fmt_vbi_out
)
935 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
:
936 if (is_vbi
&& is_rx
&& ops
->vidioc_g_fmt_sliced_vbi_cap
)
939 case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT
:
940 if (is_vbi
&& is_tx
&& ops
->vidioc_g_fmt_sliced_vbi_out
)
949 static int v4l_querycap(const struct v4l2_ioctl_ops
*ops
,
950 struct file
*file
, void *fh
, void *arg
)
952 struct v4l2_capability
*cap
= (struct v4l2_capability
*)arg
;
954 cap
->version
= LINUX_VERSION_CODE
;
955 return ops
->vidioc_querycap(file
, fh
, cap
);
958 static int v4l_s_input(const struct v4l2_ioctl_ops
*ops
,
959 struct file
*file
, void *fh
, void *arg
)
961 return ops
->vidioc_s_input(file
, fh
, *(unsigned int *)arg
);
964 static int v4l_s_output(const struct v4l2_ioctl_ops
*ops
,
965 struct file
*file
, void *fh
, void *arg
)
967 return ops
->vidioc_s_output(file
, fh
, *(unsigned int *)arg
);
970 static int v4l_g_priority(const struct v4l2_ioctl_ops
*ops
,
971 struct file
*file
, void *fh
, void *arg
)
973 struct video_device
*vfd
;
976 if (ops
->vidioc_g_priority
)
977 return ops
->vidioc_g_priority(file
, fh
, arg
);
978 vfd
= video_devdata(file
);
979 *p
= v4l2_prio_max(&vfd
->v4l2_dev
->prio
);
983 static int v4l_s_priority(const struct v4l2_ioctl_ops
*ops
,
984 struct file
*file
, void *fh
, void *arg
)
986 struct video_device
*vfd
;
990 if (ops
->vidioc_s_priority
)
991 return ops
->vidioc_s_priority(file
, fh
, *p
);
992 vfd
= video_devdata(file
);
993 vfh
= file
->private_data
;
994 return v4l2_prio_change(&vfd
->v4l2_dev
->prio
, &vfh
->prio
, *p
);
997 static int v4l_enuminput(const struct v4l2_ioctl_ops
*ops
,
998 struct file
*file
, void *fh
, void *arg
)
1000 struct v4l2_input
*p
= arg
;
1003 * We set the flags for CAP_PRESETS, CAP_DV_TIMINGS &
1004 * CAP_STD here based on ioctl handler provided by the
1005 * driver. If the driver doesn't support these
1006 * for a specific input, it must override these flags.
1008 if (ops
->vidioc_s_std
)
1009 p
->capabilities
|= V4L2_IN_CAP_STD
;
1010 if (ops
->vidioc_s_dv_preset
)
1011 p
->capabilities
|= V4L2_IN_CAP_PRESETS
;
1012 if (ops
->vidioc_s_dv_timings
)
1013 p
->capabilities
|= V4L2_IN_CAP_DV_TIMINGS
;
1015 return ops
->vidioc_enum_input(file
, fh
, p
);
1018 static int v4l_enumoutput(const struct v4l2_ioctl_ops
*ops
,
1019 struct file
*file
, void *fh
, void *arg
)
1021 struct v4l2_output
*p
= arg
;
1024 * We set the flags for CAP_PRESETS, CAP_DV_TIMINGS &
1025 * CAP_STD here based on ioctl handler provided by the
1026 * driver. If the driver doesn't support these
1027 * for a specific output, it must override these flags.
1029 if (ops
->vidioc_s_std
)
1030 p
->capabilities
|= V4L2_OUT_CAP_STD
;
1031 if (ops
->vidioc_s_dv_preset
)
1032 p
->capabilities
|= V4L2_OUT_CAP_PRESETS
;
1033 if (ops
->vidioc_s_dv_timings
)
1034 p
->capabilities
|= V4L2_OUT_CAP_DV_TIMINGS
;
1036 return ops
->vidioc_enum_output(file
, fh
, p
);
1039 static int v4l_enum_fmt(const struct v4l2_ioctl_ops
*ops
,
1040 struct file
*file
, void *fh
, void *arg
)
1042 struct v4l2_fmtdesc
*p
= arg
;
1043 struct video_device
*vfd
= video_devdata(file
);
1044 bool is_rx
= vfd
->vfl_dir
!= VFL_DIR_TX
;
1045 bool is_tx
= vfd
->vfl_dir
!= VFL_DIR_RX
;
1048 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
1049 if (unlikely(!is_rx
|| !ops
->vidioc_enum_fmt_vid_cap
))
1051 return ops
->vidioc_enum_fmt_vid_cap(file
, fh
, arg
);
1052 case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE
:
1053 if (unlikely(!is_rx
|| !ops
->vidioc_enum_fmt_vid_cap_mplane
))
1055 return ops
->vidioc_enum_fmt_vid_cap_mplane(file
, fh
, arg
);
1056 case V4L2_BUF_TYPE_VIDEO_OVERLAY
:
1057 if (unlikely(!is_rx
|| !ops
->vidioc_enum_fmt_vid_overlay
))
1059 return ops
->vidioc_enum_fmt_vid_overlay(file
, fh
, arg
);
1060 case V4L2_BUF_TYPE_VIDEO_OUTPUT
:
1061 if (unlikely(!is_tx
|| !ops
->vidioc_enum_fmt_vid_out
))
1063 return ops
->vidioc_enum_fmt_vid_out(file
, fh
, arg
);
1064 case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE
:
1065 if (unlikely(!is_tx
|| !ops
->vidioc_enum_fmt_vid_out_mplane
))
1067 return ops
->vidioc_enum_fmt_vid_out_mplane(file
, fh
, arg
);
1072 static int v4l_g_fmt(const struct v4l2_ioctl_ops
*ops
,
1073 struct file
*file
, void *fh
, void *arg
)
1075 struct v4l2_format
*p
= arg
;
1076 struct video_device
*vfd
= video_devdata(file
);
1077 bool is_vid
= vfd
->vfl_type
== VFL_TYPE_GRABBER
;
1078 bool is_rx
= vfd
->vfl_dir
!= VFL_DIR_TX
;
1079 bool is_tx
= vfd
->vfl_dir
!= VFL_DIR_RX
;
1082 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
1083 if (unlikely(!is_rx
|| !is_vid
|| !ops
->vidioc_g_fmt_vid_cap
))
1085 return ops
->vidioc_g_fmt_vid_cap(file
, fh
, arg
);
1086 case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE
:
1087 if (unlikely(!is_rx
|| !is_vid
|| !ops
->vidioc_g_fmt_vid_cap_mplane
))
1089 return ops
->vidioc_g_fmt_vid_cap_mplane(file
, fh
, arg
);
1090 case V4L2_BUF_TYPE_VIDEO_OVERLAY
:
1091 if (unlikely(!is_rx
|| !is_vid
|| !ops
->vidioc_g_fmt_vid_overlay
))
1093 return ops
->vidioc_g_fmt_vid_overlay(file
, fh
, arg
);
1094 case V4L2_BUF_TYPE_VBI_CAPTURE
:
1095 if (unlikely(!is_rx
|| is_vid
|| !ops
->vidioc_g_fmt_vbi_cap
))
1097 return ops
->vidioc_g_fmt_vbi_cap(file
, fh
, arg
);
1098 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
:
1099 if (unlikely(!is_rx
|| is_vid
|| !ops
->vidioc_g_fmt_sliced_vbi_cap
))
1101 return ops
->vidioc_g_fmt_sliced_vbi_cap(file
, fh
, arg
);
1102 case V4L2_BUF_TYPE_VIDEO_OUTPUT
:
1103 if (unlikely(!is_tx
|| !is_vid
|| !ops
->vidioc_g_fmt_vid_out
))
1105 return ops
->vidioc_g_fmt_vid_out(file
, fh
, arg
);
1106 case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE
:
1107 if (unlikely(!is_tx
|| !is_vid
|| !ops
->vidioc_g_fmt_vid_out_mplane
))
1109 return ops
->vidioc_g_fmt_vid_out_mplane(file
, fh
, arg
);
1110 case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
:
1111 if (unlikely(!is_tx
|| !is_vid
|| !ops
->vidioc_g_fmt_vid_out_overlay
))
1113 return ops
->vidioc_g_fmt_vid_out_overlay(file
, fh
, arg
);
1114 case V4L2_BUF_TYPE_VBI_OUTPUT
:
1115 if (unlikely(!is_tx
|| is_vid
|| !ops
->vidioc_g_fmt_vbi_out
))
1117 return ops
->vidioc_g_fmt_vbi_out(file
, fh
, arg
);
1118 case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT
:
1119 if (unlikely(!is_tx
|| is_vid
|| !ops
->vidioc_g_fmt_sliced_vbi_out
))
1121 return ops
->vidioc_g_fmt_sliced_vbi_out(file
, fh
, arg
);
1126 static int v4l_s_fmt(const struct v4l2_ioctl_ops
*ops
,
1127 struct file
*file
, void *fh
, void *arg
)
1129 struct v4l2_format
*p
= arg
;
1130 struct video_device
*vfd
= video_devdata(file
);
1131 bool is_vid
= vfd
->vfl_type
== VFL_TYPE_GRABBER
;
1132 bool is_rx
= vfd
->vfl_dir
!= VFL_DIR_TX
;
1133 bool is_tx
= vfd
->vfl_dir
!= VFL_DIR_RX
;
1136 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
1137 if (unlikely(!is_rx
|| !is_vid
|| !ops
->vidioc_s_fmt_vid_cap
))
1139 CLEAR_AFTER_FIELD(p
, fmt
.pix
);
1140 return ops
->vidioc_s_fmt_vid_cap(file
, fh
, arg
);
1141 case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE
:
1142 if (unlikely(!is_rx
|| !is_vid
|| !ops
->vidioc_s_fmt_vid_cap_mplane
))
1144 CLEAR_AFTER_FIELD(p
, fmt
.pix_mp
);
1145 return ops
->vidioc_s_fmt_vid_cap_mplane(file
, fh
, arg
);
1146 case V4L2_BUF_TYPE_VIDEO_OVERLAY
:
1147 if (unlikely(!is_rx
|| !is_vid
|| !ops
->vidioc_s_fmt_vid_overlay
))
1149 CLEAR_AFTER_FIELD(p
, fmt
.win
);
1150 return ops
->vidioc_s_fmt_vid_overlay(file
, fh
, arg
);
1151 case V4L2_BUF_TYPE_VBI_CAPTURE
:
1152 if (unlikely(!is_rx
|| is_vid
|| !ops
->vidioc_s_fmt_vbi_cap
))
1154 CLEAR_AFTER_FIELD(p
, fmt
.vbi
);
1155 return ops
->vidioc_s_fmt_vbi_cap(file
, fh
, arg
);
1156 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
:
1157 if (unlikely(!is_rx
|| is_vid
|| !ops
->vidioc_s_fmt_sliced_vbi_cap
))
1159 CLEAR_AFTER_FIELD(p
, fmt
.sliced
);
1160 return ops
->vidioc_s_fmt_sliced_vbi_cap(file
, fh
, arg
);
1161 case V4L2_BUF_TYPE_VIDEO_OUTPUT
:
1162 if (unlikely(!is_tx
|| !is_vid
|| !ops
->vidioc_s_fmt_vid_out
))
1164 CLEAR_AFTER_FIELD(p
, fmt
.pix
);
1165 return ops
->vidioc_s_fmt_vid_out(file
, fh
, arg
);
1166 case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE
:
1167 if (unlikely(!is_tx
|| !is_vid
|| !ops
->vidioc_s_fmt_vid_out_mplane
))
1169 CLEAR_AFTER_FIELD(p
, fmt
.pix_mp
);
1170 return ops
->vidioc_s_fmt_vid_out_mplane(file
, fh
, arg
);
1171 case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
:
1172 if (unlikely(!is_tx
|| !is_vid
|| !ops
->vidioc_s_fmt_vid_out_overlay
))
1174 CLEAR_AFTER_FIELD(p
, fmt
.win
);
1175 return ops
->vidioc_s_fmt_vid_out_overlay(file
, fh
, arg
);
1176 case V4L2_BUF_TYPE_VBI_OUTPUT
:
1177 if (unlikely(!is_tx
|| is_vid
|| !ops
->vidioc_s_fmt_vbi_out
))
1179 CLEAR_AFTER_FIELD(p
, fmt
.vbi
);
1180 return ops
->vidioc_s_fmt_vbi_out(file
, fh
, arg
);
1181 case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT
:
1182 if (unlikely(!is_tx
|| is_vid
|| !ops
->vidioc_s_fmt_sliced_vbi_out
))
1184 CLEAR_AFTER_FIELD(p
, fmt
.sliced
);
1185 return ops
->vidioc_s_fmt_sliced_vbi_out(file
, fh
, arg
);
1190 static int v4l_try_fmt(const struct v4l2_ioctl_ops
*ops
,
1191 struct file
*file
, void *fh
, void *arg
)
1193 struct v4l2_format
*p
= arg
;
1194 struct video_device
*vfd
= video_devdata(file
);
1195 bool is_vid
= vfd
->vfl_type
== VFL_TYPE_GRABBER
;
1196 bool is_rx
= vfd
->vfl_dir
!= VFL_DIR_TX
;
1197 bool is_tx
= vfd
->vfl_dir
!= VFL_DIR_RX
;
1200 case V4L2_BUF_TYPE_VIDEO_CAPTURE
:
1201 if (unlikely(!is_rx
|| !is_vid
|| !ops
->vidioc_try_fmt_vid_cap
))
1203 CLEAR_AFTER_FIELD(p
, fmt
.pix
);
1204 return ops
->vidioc_try_fmt_vid_cap(file
, fh
, arg
);
1205 case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE
:
1206 if (unlikely(!is_rx
|| !is_vid
|| !ops
->vidioc_try_fmt_vid_cap_mplane
))
1208 CLEAR_AFTER_FIELD(p
, fmt
.pix_mp
);
1209 return ops
->vidioc_try_fmt_vid_cap_mplane(file
, fh
, arg
);
1210 case V4L2_BUF_TYPE_VIDEO_OVERLAY
:
1211 if (unlikely(!is_rx
|| !is_vid
|| !ops
->vidioc_try_fmt_vid_overlay
))
1213 CLEAR_AFTER_FIELD(p
, fmt
.win
);
1214 return ops
->vidioc_try_fmt_vid_overlay(file
, fh
, arg
);
1215 case V4L2_BUF_TYPE_VBI_CAPTURE
:
1216 if (unlikely(!is_rx
|| is_vid
|| !ops
->vidioc_try_fmt_vbi_cap
))
1218 CLEAR_AFTER_FIELD(p
, fmt
.vbi
);
1219 return ops
->vidioc_try_fmt_vbi_cap(file
, fh
, arg
);
1220 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE
:
1221 if (unlikely(!is_rx
|| is_vid
|| !ops
->vidioc_try_fmt_sliced_vbi_cap
))
1223 CLEAR_AFTER_FIELD(p
, fmt
.sliced
);
1224 return ops
->vidioc_try_fmt_sliced_vbi_cap(file
, fh
, arg
);
1225 case V4L2_BUF_TYPE_VIDEO_OUTPUT
:
1226 if (unlikely(!is_tx
|| !is_vid
|| !ops
->vidioc_try_fmt_vid_out
))
1228 CLEAR_AFTER_FIELD(p
, fmt
.pix
);
1229 return ops
->vidioc_try_fmt_vid_out(file
, fh
, arg
);
1230 case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE
:
1231 if (unlikely(!is_tx
|| !is_vid
|| !ops
->vidioc_try_fmt_vid_out_mplane
))
1233 CLEAR_AFTER_FIELD(p
, fmt
.pix_mp
);
1234 return ops
->vidioc_try_fmt_vid_out_mplane(file
, fh
, arg
);
1235 case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY
:
1236 if (unlikely(!is_tx
|| !is_vid
|| !ops
->vidioc_try_fmt_vid_out_overlay
))
1238 CLEAR_AFTER_FIELD(p
, fmt
.win
);
1239 return ops
->vidioc_try_fmt_vid_out_overlay(file
, fh
, arg
);
1240 case V4L2_BUF_TYPE_VBI_OUTPUT
:
1241 if (unlikely(!is_tx
|| is_vid
|| !ops
->vidioc_try_fmt_vbi_out
))
1243 CLEAR_AFTER_FIELD(p
, fmt
.vbi
);
1244 return ops
->vidioc_try_fmt_vbi_out(file
, fh
, arg
);
1245 case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT
:
1246 if (unlikely(!is_tx
|| is_vid
|| !ops
->vidioc_try_fmt_sliced_vbi_out
))
1248 CLEAR_AFTER_FIELD(p
, fmt
.sliced
);
1249 return ops
->vidioc_try_fmt_sliced_vbi_out(file
, fh
, arg
);
1254 static int v4l_streamon(const struct v4l2_ioctl_ops
*ops
,
1255 struct file
*file
, void *fh
, void *arg
)
1257 return ops
->vidioc_streamon(file
, fh
, *(unsigned int *)arg
);
1260 static int v4l_streamoff(const struct v4l2_ioctl_ops
*ops
,
1261 struct file
*file
, void *fh
, void *arg
)
1263 return ops
->vidioc_streamoff(file
, fh
, *(unsigned int *)arg
);
1266 static int v4l_g_tuner(const struct v4l2_ioctl_ops
*ops
,
1267 struct file
*file
, void *fh
, void *arg
)
1269 struct video_device
*vfd
= video_devdata(file
);
1270 struct v4l2_tuner
*p
= arg
;
1273 p
->type
= (vfd
->vfl_type
== VFL_TYPE_RADIO
) ?
1274 V4L2_TUNER_RADIO
: V4L2_TUNER_ANALOG_TV
;
1275 err
= ops
->vidioc_g_tuner(file
, fh
, p
);
1277 p
->capability
|= V4L2_TUNER_CAP_FREQ_BANDS
;
1281 static int v4l_s_tuner(const struct v4l2_ioctl_ops
*ops
,
1282 struct file
*file
, void *fh
, void *arg
)
1284 struct video_device
*vfd
= video_devdata(file
);
1285 struct v4l2_tuner
*p
= arg
;
1287 p
->type
= (vfd
->vfl_type
== VFL_TYPE_RADIO
) ?
1288 V4L2_TUNER_RADIO
: V4L2_TUNER_ANALOG_TV
;
1289 return ops
->vidioc_s_tuner(file
, fh
, p
);
1292 static int v4l_g_modulator(const struct v4l2_ioctl_ops
*ops
,
1293 struct file
*file
, void *fh
, void *arg
)
1295 struct v4l2_modulator
*p
= arg
;
1298 err
= ops
->vidioc_g_modulator(file
, fh
, p
);
1300 p
->capability
|= V4L2_TUNER_CAP_FREQ_BANDS
;
1304 static int v4l_g_frequency(const struct v4l2_ioctl_ops
*ops
,
1305 struct file
*file
, void *fh
, void *arg
)
1307 struct video_device
*vfd
= video_devdata(file
);
1308 struct v4l2_frequency
*p
= arg
;
1310 p
->type
= (vfd
->vfl_type
== VFL_TYPE_RADIO
) ?
1311 V4L2_TUNER_RADIO
: V4L2_TUNER_ANALOG_TV
;
1312 return ops
->vidioc_g_frequency(file
, fh
, p
);
1315 static int v4l_s_frequency(const struct v4l2_ioctl_ops
*ops
,
1316 struct file
*file
, void *fh
, void *arg
)
1318 struct video_device
*vfd
= video_devdata(file
);
1319 const struct v4l2_frequency
*p
= arg
;
1320 enum v4l2_tuner_type type
;
1322 type
= (vfd
->vfl_type
== VFL_TYPE_RADIO
) ?
1323 V4L2_TUNER_RADIO
: V4L2_TUNER_ANALOG_TV
;
1324 if (p
->type
!= type
)
1326 return ops
->vidioc_s_frequency(file
, fh
, p
);
1329 static int v4l_enumstd(const struct v4l2_ioctl_ops
*ops
,
1330 struct file
*file
, void *fh
, void *arg
)
1332 struct video_device
*vfd
= video_devdata(file
);
1333 struct v4l2_standard
*p
= arg
;
1334 v4l2_std_id id
= vfd
->tvnorms
, curr_id
= 0;
1335 unsigned int index
= p
->index
, i
, j
= 0;
1336 const char *descr
= "";
1338 /* Return -ENODATA if the tvnorms for the current input
1339 or output is 0, meaning that it doesn't support this API. */
1343 /* Return norm array in a canonical way */
1344 for (i
= 0; i
<= index
&& id
; i
++) {
1345 /* last std value in the standards array is 0, so this
1346 while always ends there since (id & 0) == 0. */
1347 while ((id
& standards
[j
].std
) != standards
[j
].std
)
1349 curr_id
= standards
[j
].std
;
1350 descr
= standards
[j
].descr
;
1354 if (curr_id
!= V4L2_STD_PAL
&&
1355 curr_id
!= V4L2_STD_SECAM
&&
1356 curr_id
!= V4L2_STD_NTSC
)
1362 v4l2_video_std_construct(p
, curr_id
, descr
);
1366 static int v4l_g_std(const struct v4l2_ioctl_ops
*ops
,
1367 struct file
*file
, void *fh
, void *arg
)
1369 struct video_device
*vfd
= video_devdata(file
);
1370 v4l2_std_id
*id
= arg
;
1372 /* Calls the specific handler */
1373 if (ops
->vidioc_g_std
)
1374 return ops
->vidioc_g_std(file
, fh
, arg
);
1375 if (vfd
->current_norm
) {
1376 *id
= vfd
->current_norm
;
1382 static int v4l_s_std(const struct v4l2_ioctl_ops
*ops
,
1383 struct file
*file
, void *fh
, void *arg
)
1385 struct video_device
*vfd
= video_devdata(file
);
1386 v4l2_std_id
*id
= arg
, norm
;
1389 norm
= (*id
) & vfd
->tvnorms
;
1390 if (vfd
->tvnorms
&& !norm
) /* Check if std is supported */
1393 /* Calls the specific handler */
1394 ret
= ops
->vidioc_s_std(file
, fh
, &norm
);
1396 /* Updates standard information */
1398 vfd
->current_norm
= norm
;
1402 static int v4l_querystd(const struct v4l2_ioctl_ops
*ops
,
1403 struct file
*file
, void *fh
, void *arg
)
1405 struct video_device
*vfd
= video_devdata(file
);
1406 v4l2_std_id
*p
= arg
;
1409 * If nothing detected, it should return all supported
1411 * Drivers just need to mask the std argument, in order
1412 * to remove the standards that don't apply from the mask.
1413 * This means that tuners, audio and video decoders can join
1414 * their efforts to improve the standards detection.
1417 return ops
->vidioc_querystd(file
, fh
, arg
);
1420 static int v4l_s_hw_freq_seek(const struct v4l2_ioctl_ops
*ops
,
1421 struct file
*file
, void *fh
, void *arg
)
1423 struct video_device
*vfd
= video_devdata(file
);
1424 struct v4l2_hw_freq_seek
*p
= arg
;
1425 enum v4l2_tuner_type type
;
1427 type
= (vfd
->vfl_type
== VFL_TYPE_RADIO
) ?
1428 V4L2_TUNER_RADIO
: V4L2_TUNER_ANALOG_TV
;
1429 if (p
->type
!= type
)
1431 return ops
->vidioc_s_hw_freq_seek(file
, fh
, p
);
1434 static int v4l_overlay(const struct v4l2_ioctl_ops
*ops
,
1435 struct file
*file
, void *fh
, void *arg
)
1437 return ops
->vidioc_overlay(file
, fh
, *(unsigned int *)arg
);
1440 static int v4l_reqbufs(const struct v4l2_ioctl_ops
*ops
,
1441 struct file
*file
, void *fh
, void *arg
)
1443 struct v4l2_requestbuffers
*p
= arg
;
1444 int ret
= check_fmt(file
, p
->type
);
1449 CLEAR_AFTER_FIELD(p
, memory
);
1451 return ops
->vidioc_reqbufs(file
, fh
, p
);
1454 static int v4l_querybuf(const struct v4l2_ioctl_ops
*ops
,
1455 struct file
*file
, void *fh
, void *arg
)
1457 struct v4l2_buffer
*p
= arg
;
1458 int ret
= check_fmt(file
, p
->type
);
1460 return ret
? ret
: ops
->vidioc_querybuf(file
, fh
, p
);
1463 static int v4l_qbuf(const struct v4l2_ioctl_ops
*ops
,
1464 struct file
*file
, void *fh
, void *arg
)
1466 struct v4l2_buffer
*p
= arg
;
1467 int ret
= check_fmt(file
, p
->type
);
1469 return ret
? ret
: ops
->vidioc_qbuf(file
, fh
, p
);
1472 static int v4l_dqbuf(const struct v4l2_ioctl_ops
*ops
,
1473 struct file
*file
, void *fh
, void *arg
)
1475 struct v4l2_buffer
*p
= arg
;
1476 int ret
= check_fmt(file
, p
->type
);
1478 return ret
? ret
: ops
->vidioc_dqbuf(file
, fh
, p
);
1481 static int v4l_create_bufs(const struct v4l2_ioctl_ops
*ops
,
1482 struct file
*file
, void *fh
, void *arg
)
1484 struct v4l2_create_buffers
*create
= arg
;
1485 int ret
= check_fmt(file
, create
->format
.type
);
1487 return ret
? ret
: ops
->vidioc_create_bufs(file
, fh
, create
);
1490 static int v4l_prepare_buf(const struct v4l2_ioctl_ops
*ops
,
1491 struct file
*file
, void *fh
, void *arg
)
1493 struct v4l2_buffer
*b
= arg
;
1494 int ret
= check_fmt(file
, b
->type
);
1496 return ret
? ret
: ops
->vidioc_prepare_buf(file
, fh
, b
);
1499 static int v4l_g_parm(const struct v4l2_ioctl_ops
*ops
,
1500 struct file
*file
, void *fh
, void *arg
)
1502 struct video_device
*vfd
= video_devdata(file
);
1503 struct v4l2_streamparm
*p
= arg
;
1505 int ret
= check_fmt(file
, p
->type
);
1509 if (ops
->vidioc_g_parm
)
1510 return ops
->vidioc_g_parm(file
, fh
, p
);
1511 std
= vfd
->current_norm
;
1512 if (p
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE
&&
1513 p
->type
!= V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE
)
1515 p
->parm
.capture
.readbuffers
= 2;
1516 if (ops
->vidioc_g_std
)
1517 ret
= ops
->vidioc_g_std(file
, fh
, &std
);
1519 v4l2_video_std_frame_period(std
,
1520 &p
->parm
.capture
.timeperframe
);
1524 static int v4l_s_parm(const struct v4l2_ioctl_ops
*ops
,
1525 struct file
*file
, void *fh
, void *arg
)
1527 struct v4l2_streamparm
*p
= arg
;
1528 int ret
= check_fmt(file
, p
->type
);
1530 return ret
? ret
: ops
->vidioc_s_parm(file
, fh
, p
);
1533 static int v4l_queryctrl(const struct v4l2_ioctl_ops
*ops
,
1534 struct file
*file
, void *fh
, void *arg
)
1536 struct video_device
*vfd
= video_devdata(file
);
1537 struct v4l2_queryctrl
*p
= arg
;
1538 struct v4l2_fh
*vfh
=
1539 test_bit(V4L2_FL_USES_V4L2_FH
, &vfd
->flags
) ? fh
: NULL
;
1541 if (vfh
&& vfh
->ctrl_handler
)
1542 return v4l2_queryctrl(vfh
->ctrl_handler
, p
);
1543 if (vfd
->ctrl_handler
)
1544 return v4l2_queryctrl(vfd
->ctrl_handler
, p
);
1545 if (ops
->vidioc_queryctrl
)
1546 return ops
->vidioc_queryctrl(file
, fh
, p
);
1550 static int v4l_querymenu(const struct v4l2_ioctl_ops
*ops
,
1551 struct file
*file
, void *fh
, void *arg
)
1553 struct video_device
*vfd
= video_devdata(file
);
1554 struct v4l2_querymenu
*p
= arg
;
1555 struct v4l2_fh
*vfh
=
1556 test_bit(V4L2_FL_USES_V4L2_FH
, &vfd
->flags
) ? fh
: NULL
;
1558 if (vfh
&& vfh
->ctrl_handler
)
1559 return v4l2_querymenu(vfh
->ctrl_handler
, p
);
1560 if (vfd
->ctrl_handler
)
1561 return v4l2_querymenu(vfd
->ctrl_handler
, p
);
1562 if (ops
->vidioc_querymenu
)
1563 return ops
->vidioc_querymenu(file
, fh
, p
);
1567 static int v4l_g_ctrl(const struct v4l2_ioctl_ops
*ops
,
1568 struct file
*file
, void *fh
, void *arg
)
1570 struct video_device
*vfd
= video_devdata(file
);
1571 struct v4l2_control
*p
= arg
;
1572 struct v4l2_fh
*vfh
=
1573 test_bit(V4L2_FL_USES_V4L2_FH
, &vfd
->flags
) ? fh
: NULL
;
1574 struct v4l2_ext_controls ctrls
;
1575 struct v4l2_ext_control ctrl
;
1577 if (vfh
&& vfh
->ctrl_handler
)
1578 return v4l2_g_ctrl(vfh
->ctrl_handler
, p
);
1579 if (vfd
->ctrl_handler
)
1580 return v4l2_g_ctrl(vfd
->ctrl_handler
, p
);
1581 if (ops
->vidioc_g_ctrl
)
1582 return ops
->vidioc_g_ctrl(file
, fh
, p
);
1583 if (ops
->vidioc_g_ext_ctrls
== NULL
)
1586 ctrls
.ctrl_class
= V4L2_CTRL_ID2CLASS(p
->id
);
1588 ctrls
.controls
= &ctrl
;
1590 ctrl
.value
= p
->value
;
1591 if (check_ext_ctrls(&ctrls
, 1)) {
1592 int ret
= ops
->vidioc_g_ext_ctrls(file
, fh
, &ctrls
);
1595 p
->value
= ctrl
.value
;
1601 static int v4l_s_ctrl(const struct v4l2_ioctl_ops
*ops
,
1602 struct file
*file
, void *fh
, void *arg
)
1604 struct video_device
*vfd
= video_devdata(file
);
1605 struct v4l2_control
*p
= arg
;
1606 struct v4l2_fh
*vfh
=
1607 test_bit(V4L2_FL_USES_V4L2_FH
, &vfd
->flags
) ? fh
: NULL
;
1608 struct v4l2_ext_controls ctrls
;
1609 struct v4l2_ext_control ctrl
;
1611 if (vfh
&& vfh
->ctrl_handler
)
1612 return v4l2_s_ctrl(vfh
, vfh
->ctrl_handler
, p
);
1613 if (vfd
->ctrl_handler
)
1614 return v4l2_s_ctrl(NULL
, vfd
->ctrl_handler
, p
);
1615 if (ops
->vidioc_s_ctrl
)
1616 return ops
->vidioc_s_ctrl(file
, fh
, p
);
1617 if (ops
->vidioc_s_ext_ctrls
== NULL
)
1620 ctrls
.ctrl_class
= V4L2_CTRL_ID2CLASS(p
->id
);
1622 ctrls
.controls
= &ctrl
;
1624 ctrl
.value
= p
->value
;
1625 if (check_ext_ctrls(&ctrls
, 1))
1626 return ops
->vidioc_s_ext_ctrls(file
, fh
, &ctrls
);
1630 static int v4l_g_ext_ctrls(const struct v4l2_ioctl_ops
*ops
,
1631 struct file
*file
, void *fh
, void *arg
)
1633 struct video_device
*vfd
= video_devdata(file
);
1634 struct v4l2_ext_controls
*p
= arg
;
1635 struct v4l2_fh
*vfh
=
1636 test_bit(V4L2_FL_USES_V4L2_FH
, &vfd
->flags
) ? fh
: NULL
;
1638 p
->error_idx
= p
->count
;
1639 if (vfh
&& vfh
->ctrl_handler
)
1640 return v4l2_g_ext_ctrls(vfh
->ctrl_handler
, p
);
1641 if (vfd
->ctrl_handler
)
1642 return v4l2_g_ext_ctrls(vfd
->ctrl_handler
, p
);
1643 if (ops
->vidioc_g_ext_ctrls
== NULL
)
1645 return check_ext_ctrls(p
, 0) ? ops
->vidioc_g_ext_ctrls(file
, fh
, p
) :
1649 static int v4l_s_ext_ctrls(const struct v4l2_ioctl_ops
*ops
,
1650 struct file
*file
, void *fh
, void *arg
)
1652 struct video_device
*vfd
= video_devdata(file
);
1653 struct v4l2_ext_controls
*p
= arg
;
1654 struct v4l2_fh
*vfh
=
1655 test_bit(V4L2_FL_USES_V4L2_FH
, &vfd
->flags
) ? fh
: NULL
;
1657 p
->error_idx
= p
->count
;
1658 if (vfh
&& vfh
->ctrl_handler
)
1659 return v4l2_s_ext_ctrls(vfh
, vfh
->ctrl_handler
, p
);
1660 if (vfd
->ctrl_handler
)
1661 return v4l2_s_ext_ctrls(NULL
, vfd
->ctrl_handler
, p
);
1662 if (ops
->vidioc_s_ext_ctrls
== NULL
)
1664 return check_ext_ctrls(p
, 0) ? ops
->vidioc_s_ext_ctrls(file
, fh
, p
) :
1668 static int v4l_try_ext_ctrls(const struct v4l2_ioctl_ops
*ops
,
1669 struct file
*file
, void *fh
, void *arg
)
1671 struct video_device
*vfd
= video_devdata(file
);
1672 struct v4l2_ext_controls
*p
= arg
;
1673 struct v4l2_fh
*vfh
=
1674 test_bit(V4L2_FL_USES_V4L2_FH
, &vfd
->flags
) ? fh
: NULL
;
1676 p
->error_idx
= p
->count
;
1677 if (vfh
&& vfh
->ctrl_handler
)
1678 return v4l2_try_ext_ctrls(vfh
->ctrl_handler
, p
);
1679 if (vfd
->ctrl_handler
)
1680 return v4l2_try_ext_ctrls(vfd
->ctrl_handler
, p
);
1681 if (ops
->vidioc_try_ext_ctrls
== NULL
)
1683 return check_ext_ctrls(p
, 0) ? ops
->vidioc_try_ext_ctrls(file
, fh
, p
) :
1687 static int v4l_g_crop(const struct v4l2_ioctl_ops
*ops
,
1688 struct file
*file
, void *fh
, void *arg
)
1690 struct v4l2_crop
*p
= arg
;
1691 struct v4l2_selection s
= {
1696 if (ops
->vidioc_g_crop
)
1697 return ops
->vidioc_g_crop(file
, fh
, p
);
1698 /* simulate capture crop using selection api */
1700 /* crop means compose for output devices */
1701 if (V4L2_TYPE_IS_OUTPUT(p
->type
))
1702 s
.target
= V4L2_SEL_TGT_COMPOSE_ACTIVE
;
1704 s
.target
= V4L2_SEL_TGT_CROP_ACTIVE
;
1706 ret
= ops
->vidioc_g_selection(file
, fh
, &s
);
1708 /* copying results to old structure on success */
1714 static int v4l_s_crop(const struct v4l2_ioctl_ops
*ops
,
1715 struct file
*file
, void *fh
, void *arg
)
1717 struct v4l2_crop
*p
= arg
;
1718 struct v4l2_selection s
= {
1723 if (ops
->vidioc_s_crop
)
1724 return ops
->vidioc_s_crop(file
, fh
, p
);
1725 /* simulate capture crop using selection api */
1727 /* crop means compose for output devices */
1728 if (V4L2_TYPE_IS_OUTPUT(p
->type
))
1729 s
.target
= V4L2_SEL_TGT_COMPOSE_ACTIVE
;
1731 s
.target
= V4L2_SEL_TGT_CROP_ACTIVE
;
1733 return ops
->vidioc_s_selection(file
, fh
, &s
);
1736 static int v4l_cropcap(const struct v4l2_ioctl_ops
*ops
,
1737 struct file
*file
, void *fh
, void *arg
)
1739 struct v4l2_cropcap
*p
= arg
;
1740 struct v4l2_selection s
= { .type
= p
->type
};
1743 if (ops
->vidioc_cropcap
)
1744 return ops
->vidioc_cropcap(file
, fh
, p
);
1746 /* obtaining bounds */
1747 if (V4L2_TYPE_IS_OUTPUT(p
->type
))
1748 s
.target
= V4L2_SEL_TGT_COMPOSE_BOUNDS
;
1750 s
.target
= V4L2_SEL_TGT_CROP_BOUNDS
;
1752 ret
= ops
->vidioc_g_selection(file
, fh
, &s
);
1757 /* obtaining defrect */
1758 if (V4L2_TYPE_IS_OUTPUT(p
->type
))
1759 s
.target
= V4L2_SEL_TGT_COMPOSE_DEFAULT
;
1761 s
.target
= V4L2_SEL_TGT_CROP_DEFAULT
;
1763 ret
= ops
->vidioc_g_selection(file
, fh
, &s
);
1768 /* setting trivial pixelaspect */
1769 p
->pixelaspect
.numerator
= 1;
1770 p
->pixelaspect
.denominator
= 1;
1774 static int v4l_log_status(const struct v4l2_ioctl_ops
*ops
,
1775 struct file
*file
, void *fh
, void *arg
)
1777 struct video_device
*vfd
= video_devdata(file
);
1781 pr_info("%s: ================= START STATUS =================\n",
1782 vfd
->v4l2_dev
->name
);
1783 ret
= ops
->vidioc_log_status(file
, fh
);
1785 pr_info("%s: ================== END STATUS ==================\n",
1786 vfd
->v4l2_dev
->name
);
1790 static int v4l_dbg_g_register(const struct v4l2_ioctl_ops
*ops
,
1791 struct file
*file
, void *fh
, void *arg
)
1793 #ifdef CONFIG_VIDEO_ADV_DEBUG
1794 struct v4l2_dbg_register
*p
= arg
;
1796 if (!capable(CAP_SYS_ADMIN
))
1798 return ops
->vidioc_g_register(file
, fh
, p
);
1804 static int v4l_dbg_s_register(const struct v4l2_ioctl_ops
*ops
,
1805 struct file
*file
, void *fh
, void *arg
)
1807 #ifdef CONFIG_VIDEO_ADV_DEBUG
1808 struct v4l2_dbg_register
*p
= arg
;
1810 if (!capable(CAP_SYS_ADMIN
))
1812 return ops
->vidioc_s_register(file
, fh
, p
);
1818 static int v4l_dbg_g_chip_ident(const struct v4l2_ioctl_ops
*ops
,
1819 struct file
*file
, void *fh
, void *arg
)
1821 struct v4l2_dbg_chip_ident
*p
= arg
;
1823 p
->ident
= V4L2_IDENT_NONE
;
1825 return ops
->vidioc_g_chip_ident(file
, fh
, p
);
1828 static int v4l_dqevent(const struct v4l2_ioctl_ops
*ops
,
1829 struct file
*file
, void *fh
, void *arg
)
1831 return v4l2_event_dequeue(fh
, arg
, file
->f_flags
& O_NONBLOCK
);
1834 static int v4l_subscribe_event(const struct v4l2_ioctl_ops
*ops
,
1835 struct file
*file
, void *fh
, void *arg
)
1837 return ops
->vidioc_subscribe_event(fh
, arg
);
1840 static int v4l_unsubscribe_event(const struct v4l2_ioctl_ops
*ops
,
1841 struct file
*file
, void *fh
, void *arg
)
1843 return ops
->vidioc_unsubscribe_event(fh
, arg
);
1846 static int v4l_g_sliced_vbi_cap(const struct v4l2_ioctl_ops
*ops
,
1847 struct file
*file
, void *fh
, void *arg
)
1849 struct v4l2_sliced_vbi_cap
*p
= arg
;
1850 int ret
= check_fmt(file
, p
->type
);
1855 /* Clear up to type, everything after type is zeroed already */
1856 memset(p
, 0, offsetof(struct v4l2_sliced_vbi_cap
, type
));
1858 return ops
->vidioc_g_sliced_vbi_cap(file
, fh
, p
);
1861 static int v4l_enum_freq_bands(const struct v4l2_ioctl_ops
*ops
,
1862 struct file
*file
, void *fh
, void *arg
)
1864 struct video_device
*vfd
= video_devdata(file
);
1865 struct v4l2_frequency_band
*p
= arg
;
1866 enum v4l2_tuner_type type
;
1869 type
= (vfd
->vfl_type
== VFL_TYPE_RADIO
) ?
1870 V4L2_TUNER_RADIO
: V4L2_TUNER_ANALOG_TV
;
1872 if (type
!= p
->type
)
1874 if (ops
->vidioc_enum_freq_bands
)
1875 return ops
->vidioc_enum_freq_bands(file
, fh
, p
);
1876 if (ops
->vidioc_g_tuner
) {
1877 struct v4l2_tuner t
= {
1884 err
= ops
->vidioc_g_tuner(file
, fh
, &t
);
1887 p
->capability
= t
.capability
| V4L2_TUNER_CAP_FREQ_BANDS
;
1888 p
->rangelow
= t
.rangelow
;
1889 p
->rangehigh
= t
.rangehigh
;
1890 p
->modulation
= (type
== V4L2_TUNER_RADIO
) ?
1891 V4L2_BAND_MODULATION_FM
: V4L2_BAND_MODULATION_VSB
;
1894 if (ops
->vidioc_g_modulator
) {
1895 struct v4l2_modulator m
= {
1899 if (type
!= V4L2_TUNER_RADIO
)
1903 err
= ops
->vidioc_g_modulator(file
, fh
, &m
);
1906 p
->capability
= m
.capability
| V4L2_TUNER_CAP_FREQ_BANDS
;
1907 p
->rangelow
= m
.rangelow
;
1908 p
->rangehigh
= m
.rangehigh
;
1909 p
->modulation
= (type
== V4L2_TUNER_RADIO
) ?
1910 V4L2_BAND_MODULATION_FM
: V4L2_BAND_MODULATION_VSB
;
1916 struct v4l2_ioctl_info
{
1919 const char * const name
;
1922 int (*func
)(const struct v4l2_ioctl_ops
*ops
,
1923 struct file
*file
, void *fh
, void *p
);
1925 void (*debug
)(const void *arg
, bool write_only
);
1928 /* This control needs a priority check */
1929 #define INFO_FL_PRIO (1 << 0)
1930 /* This control can be valid if the filehandle passes a control handler. */
1931 #define INFO_FL_CTRL (1 << 1)
1932 /* This is a standard ioctl, no need for special code */
1933 #define INFO_FL_STD (1 << 2)
1934 /* This is ioctl has its own function */
1935 #define INFO_FL_FUNC (1 << 3)
1937 #define INFO_FL_QUEUE (1 << 4)
1938 /* Zero struct from after the field to the end */
1939 #define INFO_FL_CLEAR(v4l2_struct, field) \
1940 ((offsetof(struct v4l2_struct, field) + \
1941 sizeof(((struct v4l2_struct *)0)->field)) << 16)
1942 #define INFO_FL_CLEAR_MASK (_IOC_SIZEMASK << 16)
1944 #define IOCTL_INFO_STD(_ioctl, _vidioc, _debug, _flags) \
1945 [_IOC_NR(_ioctl)] = { \
1947 .flags = _flags | INFO_FL_STD, \
1949 .u.offset = offsetof(struct v4l2_ioctl_ops, _vidioc), \
1953 #define IOCTL_INFO_FNC(_ioctl, _func, _debug, _flags) \
1954 [_IOC_NR(_ioctl)] = { \
1956 .flags = _flags | INFO_FL_FUNC, \
1962 static struct v4l2_ioctl_info v4l2_ioctls
[] = {
1963 IOCTL_INFO_FNC(VIDIOC_QUERYCAP
, v4l_querycap
, v4l_print_querycap
, 0),
1964 IOCTL_INFO_FNC(VIDIOC_ENUM_FMT
, v4l_enum_fmt
, v4l_print_fmtdesc
, INFO_FL_CLEAR(v4l2_fmtdesc
, type
)),
1965 IOCTL_INFO_FNC(VIDIOC_G_FMT
, v4l_g_fmt
, v4l_print_format
, INFO_FL_CLEAR(v4l2_format
, type
)),
1966 IOCTL_INFO_FNC(VIDIOC_S_FMT
, v4l_s_fmt
, v4l_print_format
, INFO_FL_PRIO
),
1967 IOCTL_INFO_FNC(VIDIOC_REQBUFS
, v4l_reqbufs
, v4l_print_requestbuffers
, INFO_FL_PRIO
| INFO_FL_QUEUE
),
1968 IOCTL_INFO_FNC(VIDIOC_QUERYBUF
, v4l_querybuf
, v4l_print_buffer
, INFO_FL_QUEUE
| INFO_FL_CLEAR(v4l2_buffer
, length
)),
1969 IOCTL_INFO_STD(VIDIOC_G_FBUF
, vidioc_g_fbuf
, v4l_print_framebuffer
, 0),
1970 IOCTL_INFO_STD(VIDIOC_S_FBUF
, vidioc_s_fbuf
, v4l_print_framebuffer
, INFO_FL_PRIO
),
1971 IOCTL_INFO_FNC(VIDIOC_OVERLAY
, v4l_overlay
, v4l_print_u32
, INFO_FL_PRIO
),
1972 IOCTL_INFO_FNC(VIDIOC_QBUF
, v4l_qbuf
, v4l_print_buffer
, INFO_FL_QUEUE
),
1973 IOCTL_INFO_STD(VIDIOC_EXPBUF
, vidioc_expbuf
, v4l_print_exportbuffer
, INFO_FL_QUEUE
| INFO_FL_CLEAR(v4l2_exportbuffer
, flags
)),
1974 IOCTL_INFO_FNC(VIDIOC_DQBUF
, v4l_dqbuf
, v4l_print_buffer
, INFO_FL_QUEUE
),
1975 IOCTL_INFO_FNC(VIDIOC_STREAMON
, v4l_streamon
, v4l_print_buftype
, INFO_FL_PRIO
| INFO_FL_QUEUE
),
1976 IOCTL_INFO_FNC(VIDIOC_STREAMOFF
, v4l_streamoff
, v4l_print_buftype
, INFO_FL_PRIO
| INFO_FL_QUEUE
),
1977 IOCTL_INFO_FNC(VIDIOC_G_PARM
, v4l_g_parm
, v4l_print_streamparm
, INFO_FL_CLEAR(v4l2_streamparm
, type
)),
1978 IOCTL_INFO_FNC(VIDIOC_S_PARM
, v4l_s_parm
, v4l_print_streamparm
, INFO_FL_PRIO
),
1979 IOCTL_INFO_FNC(VIDIOC_G_STD
, v4l_g_std
, v4l_print_std
, 0),
1980 IOCTL_INFO_FNC(VIDIOC_S_STD
, v4l_s_std
, v4l_print_std
, INFO_FL_PRIO
),
1981 IOCTL_INFO_FNC(VIDIOC_ENUMSTD
, v4l_enumstd
, v4l_print_standard
, INFO_FL_CLEAR(v4l2_standard
, index
)),
1982 IOCTL_INFO_FNC(VIDIOC_ENUMINPUT
, v4l_enuminput
, v4l_print_enuminput
, INFO_FL_CLEAR(v4l2_input
, index
)),
1983 IOCTL_INFO_FNC(VIDIOC_G_CTRL
, v4l_g_ctrl
, v4l_print_control
, INFO_FL_CTRL
| INFO_FL_CLEAR(v4l2_control
, id
)),
1984 IOCTL_INFO_FNC(VIDIOC_S_CTRL
, v4l_s_ctrl
, v4l_print_control
, INFO_FL_PRIO
| INFO_FL_CTRL
),
1985 IOCTL_INFO_FNC(VIDIOC_G_TUNER
, v4l_g_tuner
, v4l_print_tuner
, INFO_FL_CLEAR(v4l2_tuner
, index
)),
1986 IOCTL_INFO_FNC(VIDIOC_S_TUNER
, v4l_s_tuner
, v4l_print_tuner
, INFO_FL_PRIO
),
1987 IOCTL_INFO_STD(VIDIOC_G_AUDIO
, vidioc_g_audio
, v4l_print_audio
, 0),
1988 IOCTL_INFO_STD(VIDIOC_S_AUDIO
, vidioc_s_audio
, v4l_print_audio
, INFO_FL_PRIO
),
1989 IOCTL_INFO_FNC(VIDIOC_QUERYCTRL
, v4l_queryctrl
, v4l_print_queryctrl
, INFO_FL_CTRL
| INFO_FL_CLEAR(v4l2_queryctrl
, id
)),
1990 IOCTL_INFO_FNC(VIDIOC_QUERYMENU
, v4l_querymenu
, v4l_print_querymenu
, INFO_FL_CTRL
| INFO_FL_CLEAR(v4l2_querymenu
, index
)),
1991 IOCTL_INFO_STD(VIDIOC_G_INPUT
, vidioc_g_input
, v4l_print_u32
, 0),
1992 IOCTL_INFO_FNC(VIDIOC_S_INPUT
, v4l_s_input
, v4l_print_u32
, INFO_FL_PRIO
),
1993 IOCTL_INFO_STD(VIDIOC_G_OUTPUT
, vidioc_g_output
, v4l_print_u32
, 0),
1994 IOCTL_INFO_FNC(VIDIOC_S_OUTPUT
, v4l_s_output
, v4l_print_u32
, INFO_FL_PRIO
),
1995 IOCTL_INFO_FNC(VIDIOC_ENUMOUTPUT
, v4l_enumoutput
, v4l_print_enumoutput
, INFO_FL_CLEAR(v4l2_output
, index
)),
1996 IOCTL_INFO_STD(VIDIOC_G_AUDOUT
, vidioc_g_audout
, v4l_print_audioout
, 0),
1997 IOCTL_INFO_STD(VIDIOC_S_AUDOUT
, vidioc_s_audout
, v4l_print_audioout
, INFO_FL_PRIO
),
1998 IOCTL_INFO_FNC(VIDIOC_G_MODULATOR
, v4l_g_modulator
, v4l_print_modulator
, INFO_FL_CLEAR(v4l2_modulator
, index
)),
1999 IOCTL_INFO_STD(VIDIOC_S_MODULATOR
, vidioc_s_modulator
, v4l_print_modulator
, INFO_FL_PRIO
),
2000 IOCTL_INFO_FNC(VIDIOC_G_FREQUENCY
, v4l_g_frequency
, v4l_print_frequency
, INFO_FL_CLEAR(v4l2_frequency
, tuner
)),
2001 IOCTL_INFO_FNC(VIDIOC_S_FREQUENCY
, v4l_s_frequency
, v4l_print_frequency
, INFO_FL_PRIO
),
2002 IOCTL_INFO_FNC(VIDIOC_CROPCAP
, v4l_cropcap
, v4l_print_cropcap
, INFO_FL_CLEAR(v4l2_cropcap
, type
)),
2003 IOCTL_INFO_FNC(VIDIOC_G_CROP
, v4l_g_crop
, v4l_print_crop
, INFO_FL_CLEAR(v4l2_crop
, type
)),
2004 IOCTL_INFO_FNC(VIDIOC_S_CROP
, v4l_s_crop
, v4l_print_crop
, INFO_FL_PRIO
),
2005 IOCTL_INFO_STD(VIDIOC_G_SELECTION
, vidioc_g_selection
, v4l_print_selection
, 0),
2006 IOCTL_INFO_STD(VIDIOC_S_SELECTION
, vidioc_s_selection
, v4l_print_selection
, INFO_FL_PRIO
),
2007 IOCTL_INFO_STD(VIDIOC_G_JPEGCOMP
, vidioc_g_jpegcomp
, v4l_print_jpegcompression
, 0),
2008 IOCTL_INFO_STD(VIDIOC_S_JPEGCOMP
, vidioc_s_jpegcomp
, v4l_print_jpegcompression
, INFO_FL_PRIO
),
2009 IOCTL_INFO_FNC(VIDIOC_QUERYSTD
, v4l_querystd
, v4l_print_std
, 0),
2010 IOCTL_INFO_FNC(VIDIOC_TRY_FMT
, v4l_try_fmt
, v4l_print_format
, 0),
2011 IOCTL_INFO_STD(VIDIOC_ENUMAUDIO
, vidioc_enumaudio
, v4l_print_audio
, INFO_FL_CLEAR(v4l2_audio
, index
)),
2012 IOCTL_INFO_STD(VIDIOC_ENUMAUDOUT
, vidioc_enumaudout
, v4l_print_audioout
, INFO_FL_CLEAR(v4l2_audioout
, index
)),
2013 IOCTL_INFO_FNC(VIDIOC_G_PRIORITY
, v4l_g_priority
, v4l_print_u32
, 0),
2014 IOCTL_INFO_FNC(VIDIOC_S_PRIORITY
, v4l_s_priority
, v4l_print_u32
, INFO_FL_PRIO
),
2015 IOCTL_INFO_FNC(VIDIOC_G_SLICED_VBI_CAP
, v4l_g_sliced_vbi_cap
, v4l_print_sliced_vbi_cap
, INFO_FL_CLEAR(v4l2_sliced_vbi_cap
, type
)),
2016 IOCTL_INFO_FNC(VIDIOC_LOG_STATUS
, v4l_log_status
, v4l_print_newline
, 0),
2017 IOCTL_INFO_FNC(VIDIOC_G_EXT_CTRLS
, v4l_g_ext_ctrls
, v4l_print_ext_controls
, INFO_FL_CTRL
),
2018 IOCTL_INFO_FNC(VIDIOC_S_EXT_CTRLS
, v4l_s_ext_ctrls
, v4l_print_ext_controls
, INFO_FL_PRIO
| INFO_FL_CTRL
),
2019 IOCTL_INFO_FNC(VIDIOC_TRY_EXT_CTRLS
, v4l_try_ext_ctrls
, v4l_print_ext_controls
, INFO_FL_CTRL
),
2020 IOCTL_INFO_STD(VIDIOC_ENUM_FRAMESIZES
, vidioc_enum_framesizes
, v4l_print_frmsizeenum
, INFO_FL_CLEAR(v4l2_frmsizeenum
, pixel_format
)),
2021 IOCTL_INFO_STD(VIDIOC_ENUM_FRAMEINTERVALS
, vidioc_enum_frameintervals
, v4l_print_frmivalenum
, INFO_FL_CLEAR(v4l2_frmivalenum
, height
)),
2022 IOCTL_INFO_STD(VIDIOC_G_ENC_INDEX
, vidioc_g_enc_index
, v4l_print_enc_idx
, 0),
2023 IOCTL_INFO_STD(VIDIOC_ENCODER_CMD
, vidioc_encoder_cmd
, v4l_print_encoder_cmd
, INFO_FL_PRIO
| INFO_FL_CLEAR(v4l2_encoder_cmd
, flags
)),
2024 IOCTL_INFO_STD(VIDIOC_TRY_ENCODER_CMD
, vidioc_try_encoder_cmd
, v4l_print_encoder_cmd
, INFO_FL_CLEAR(v4l2_encoder_cmd
, flags
)),
2025 IOCTL_INFO_STD(VIDIOC_DECODER_CMD
, vidioc_decoder_cmd
, v4l_print_decoder_cmd
, INFO_FL_PRIO
),
2026 IOCTL_INFO_STD(VIDIOC_TRY_DECODER_CMD
, vidioc_try_decoder_cmd
, v4l_print_decoder_cmd
, 0),
2027 IOCTL_INFO_FNC(VIDIOC_DBG_S_REGISTER
, v4l_dbg_s_register
, v4l_print_dbg_register
, 0),
2028 IOCTL_INFO_FNC(VIDIOC_DBG_G_REGISTER
, v4l_dbg_g_register
, v4l_print_dbg_register
, 0),
2029 IOCTL_INFO_FNC(VIDIOC_DBG_G_CHIP_IDENT
, v4l_dbg_g_chip_ident
, v4l_print_dbg_chip_ident
, 0),
2030 IOCTL_INFO_FNC(VIDIOC_S_HW_FREQ_SEEK
, v4l_s_hw_freq_seek
, v4l_print_hw_freq_seek
, INFO_FL_PRIO
),
2031 IOCTL_INFO_STD(VIDIOC_ENUM_DV_PRESETS
, vidioc_enum_dv_presets
, v4l_print_dv_enum_presets
, 0),
2032 IOCTL_INFO_STD(VIDIOC_S_DV_PRESET
, vidioc_s_dv_preset
, v4l_print_dv_preset
, INFO_FL_PRIO
),
2033 IOCTL_INFO_STD(VIDIOC_G_DV_PRESET
, vidioc_g_dv_preset
, v4l_print_dv_preset
, 0),
2034 IOCTL_INFO_STD(VIDIOC_QUERY_DV_PRESET
, vidioc_query_dv_preset
, v4l_print_dv_preset
, 0),
2035 IOCTL_INFO_STD(VIDIOC_S_DV_TIMINGS
, vidioc_s_dv_timings
, v4l_print_dv_timings
, INFO_FL_PRIO
),
2036 IOCTL_INFO_STD(VIDIOC_G_DV_TIMINGS
, vidioc_g_dv_timings
, v4l_print_dv_timings
, 0),
2037 IOCTL_INFO_FNC(VIDIOC_DQEVENT
, v4l_dqevent
, v4l_print_event
, 0),
2038 IOCTL_INFO_FNC(VIDIOC_SUBSCRIBE_EVENT
, v4l_subscribe_event
, v4l_print_event_subscription
, 0),
2039 IOCTL_INFO_FNC(VIDIOC_UNSUBSCRIBE_EVENT
, v4l_unsubscribe_event
, v4l_print_event_subscription
, 0),
2040 IOCTL_INFO_FNC(VIDIOC_CREATE_BUFS
, v4l_create_bufs
, v4l_print_create_buffers
, INFO_FL_PRIO
| INFO_FL_QUEUE
),
2041 IOCTL_INFO_FNC(VIDIOC_PREPARE_BUF
, v4l_prepare_buf
, v4l_print_buffer
, INFO_FL_QUEUE
),
2042 IOCTL_INFO_STD(VIDIOC_ENUM_DV_TIMINGS
, vidioc_enum_dv_timings
, v4l_print_enum_dv_timings
, 0),
2043 IOCTL_INFO_STD(VIDIOC_QUERY_DV_TIMINGS
, vidioc_query_dv_timings
, v4l_print_dv_timings
, 0),
2044 IOCTL_INFO_STD(VIDIOC_DV_TIMINGS_CAP
, vidioc_dv_timings_cap
, v4l_print_dv_timings_cap
, INFO_FL_CLEAR(v4l2_dv_timings_cap
, type
)),
2045 IOCTL_INFO_FNC(VIDIOC_ENUM_FREQ_BANDS
, v4l_enum_freq_bands
, v4l_print_freq_band
, 0),
2047 #define V4L2_IOCTLS ARRAY_SIZE(v4l2_ioctls)
2049 bool v4l2_is_known_ioctl(unsigned int cmd
)
2051 if (_IOC_NR(cmd
) >= V4L2_IOCTLS
)
2053 return v4l2_ioctls
[_IOC_NR(cmd
)].ioctl
== cmd
;
2056 struct mutex
*v4l2_ioctl_get_lock(struct video_device
*vdev
, unsigned cmd
)
2058 if (_IOC_NR(cmd
) >= V4L2_IOCTLS
)
2060 if (test_bit(_IOC_NR(cmd
), vdev
->disable_locking
))
2062 if (vdev
->queue
&& vdev
->queue
->lock
&&
2063 (v4l2_ioctls
[_IOC_NR(cmd
)].flags
& INFO_FL_QUEUE
))
2064 return vdev
->queue
->lock
;
2068 /* Common ioctl debug function. This function can be used by
2069 external ioctl messages as well as internal V4L ioctl */
2070 void v4l_printk_ioctl(const char *prefix
, unsigned int cmd
)
2072 const char *dir
, *type
;
2075 printk(KERN_DEBUG
"%s: ", prefix
);
2077 switch (_IOC_TYPE(cmd
)) {
2082 if (_IOC_NR(cmd
) >= V4L2_IOCTLS
) {
2086 pr_cont("%s", v4l2_ioctls
[_IOC_NR(cmd
)].name
);
2093 switch (_IOC_DIR(cmd
)) {
2094 case _IOC_NONE
: dir
= "--"; break;
2095 case _IOC_READ
: dir
= "r-"; break;
2096 case _IOC_WRITE
: dir
= "-w"; break;
2097 case _IOC_READ
| _IOC_WRITE
: dir
= "rw"; break;
2098 default: dir
= "*ERR*"; break;
2100 pr_cont("%s ioctl '%c', dir=%s, #%d (0x%08x)",
2101 type
, _IOC_TYPE(cmd
), dir
, _IOC_NR(cmd
), cmd
);
2103 EXPORT_SYMBOL(v4l_printk_ioctl
);
2105 static long __video_do_ioctl(struct file
*file
,
2106 unsigned int cmd
, void *arg
)
2108 struct video_device
*vfd
= video_devdata(file
);
2109 const struct v4l2_ioctl_ops
*ops
= vfd
->ioctl_ops
;
2110 bool write_only
= false;
2111 struct v4l2_ioctl_info default_info
;
2112 const struct v4l2_ioctl_info
*info
;
2113 void *fh
= file
->private_data
;
2114 struct v4l2_fh
*vfh
= NULL
;
2115 int use_fh_prio
= 0;
2116 int debug
= vfd
->debug
;
2120 pr_warn("%s: has no ioctl_ops.\n",
2121 video_device_node_name(vfd
));
2125 if (test_bit(V4L2_FL_USES_V4L2_FH
, &vfd
->flags
)) {
2126 vfh
= file
->private_data
;
2127 use_fh_prio
= test_bit(V4L2_FL_USE_FH_PRIO
, &vfd
->flags
);
2130 if (v4l2_is_known_ioctl(cmd
)) {
2131 info
= &v4l2_ioctls
[_IOC_NR(cmd
)];
2133 if (!test_bit(_IOC_NR(cmd
), vfd
->valid_ioctls
) &&
2134 !((info
->flags
& INFO_FL_CTRL
) && vfh
&& vfh
->ctrl_handler
))
2137 if (use_fh_prio
&& (info
->flags
& INFO_FL_PRIO
)) {
2138 ret
= v4l2_prio_check(vfd
->prio
, vfh
->prio
);
2143 default_info
.ioctl
= cmd
;
2144 default_info
.flags
= 0;
2145 default_info
.debug
= v4l_print_default
;
2146 info
= &default_info
;
2149 write_only
= _IOC_DIR(cmd
) == _IOC_WRITE
;
2150 if (write_only
&& debug
> V4L2_DEBUG_IOCTL
) {
2151 v4l_printk_ioctl(video_device_node_name(vfd
), cmd
);
2153 info
->debug(arg
, write_only
);
2155 if (info
->flags
& INFO_FL_STD
) {
2156 typedef int (*vidioc_op
)(struct file
*file
, void *fh
, void *p
);
2157 const void *p
= vfd
->ioctl_ops
;
2158 const vidioc_op
*vidioc
= p
+ info
->u
.offset
;
2160 ret
= (*vidioc
)(file
, fh
, arg
);
2161 } else if (info
->flags
& INFO_FL_FUNC
) {
2162 ret
= info
->u
.func(ops
, file
, fh
, arg
);
2163 } else if (!ops
->vidioc_default
) {
2166 ret
= ops
->vidioc_default(file
, fh
,
2167 use_fh_prio
? v4l2_prio_check(vfd
->prio
, vfh
->prio
) >= 0 : 0,
2173 if (write_only
&& debug
> V4L2_DEBUG_IOCTL
) {
2175 printk(KERN_DEBUG
"%s: error %ld\n",
2176 video_device_node_name(vfd
), ret
);
2179 v4l_printk_ioctl(video_device_node_name(vfd
), cmd
);
2181 pr_cont(": error %ld\n", ret
);
2182 else if (debug
== V4L2_DEBUG_IOCTL
)
2184 else if (_IOC_DIR(cmd
) == _IOC_NONE
)
2185 info
->debug(arg
, write_only
);
2188 info
->debug(arg
, write_only
);
2195 static int check_array_args(unsigned int cmd
, void *parg
, size_t *array_size
,
2196 void * __user
*user_ptr
, void ***kernel_ptr
)
2201 case VIDIOC_PREPARE_BUF
:
2202 case VIDIOC_QUERYBUF
:
2204 case VIDIOC_DQBUF
: {
2205 struct v4l2_buffer
*buf
= parg
;
2207 if (V4L2_TYPE_IS_MULTIPLANAR(buf
->type
) && buf
->length
> 0) {
2208 if (buf
->length
> VIDEO_MAX_PLANES
) {
2212 *user_ptr
= (void __user
*)buf
->m
.planes
;
2213 *kernel_ptr
= (void *)&buf
->m
.planes
;
2214 *array_size
= sizeof(struct v4l2_plane
) * buf
->length
;
2220 case VIDIOC_SUBDEV_G_EDID
:
2221 case VIDIOC_SUBDEV_S_EDID
: {
2222 struct v4l2_subdev_edid
*edid
= parg
;
2225 if (edid
->blocks
> 256) {
2229 *user_ptr
= (void __user
*)edid
->edid
;
2230 *kernel_ptr
= (void *)&edid
->edid
;
2231 *array_size
= edid
->blocks
* 128;
2237 case VIDIOC_S_EXT_CTRLS
:
2238 case VIDIOC_G_EXT_CTRLS
:
2239 case VIDIOC_TRY_EXT_CTRLS
: {
2240 struct v4l2_ext_controls
*ctrls
= parg
;
2242 if (ctrls
->count
!= 0) {
2243 if (ctrls
->count
> V4L2_CID_MAX_CTRLS
) {
2247 *user_ptr
= (void __user
*)ctrls
->controls
;
2248 *kernel_ptr
= (void *)&ctrls
->controls
;
2249 *array_size
= sizeof(struct v4l2_ext_control
)
2261 video_usercopy(struct file
*file
, unsigned int cmd
, unsigned long arg
,
2266 void *parg
= (void *)arg
;
2268 bool has_array_args
;
2269 size_t array_size
= 0;
2270 void __user
*user_ptr
= NULL
;
2271 void **kernel_ptr
= NULL
;
2273 /* Copy arguments into temp kernel buffer */
2274 if (_IOC_DIR(cmd
) != _IOC_NONE
) {
2275 if (_IOC_SIZE(cmd
) <= sizeof(sbuf
)) {
2278 /* too big to allocate from stack */
2279 mbuf
= kmalloc(_IOC_SIZE(cmd
), GFP_KERNEL
);
2286 if (_IOC_DIR(cmd
) & _IOC_WRITE
) {
2287 unsigned int n
= _IOC_SIZE(cmd
);
2290 * In some cases, only a few fields are used as input,
2291 * i.e. when the app sets "index" and then the driver
2292 * fills in the rest of the structure for the thing
2293 * with that index. We only need to copy up the first
2296 if (v4l2_is_known_ioctl(cmd
)) {
2297 u32 flags
= v4l2_ioctls
[_IOC_NR(cmd
)].flags
;
2298 if (flags
& INFO_FL_CLEAR_MASK
)
2299 n
= (flags
& INFO_FL_CLEAR_MASK
) >> 16;
2302 if (copy_from_user(parg
, (void __user
*)arg
, n
))
2305 /* zero out anything we don't copy from userspace */
2306 if (n
< _IOC_SIZE(cmd
))
2307 memset((u8
*)parg
+ n
, 0, _IOC_SIZE(cmd
) - n
);
2309 /* read-only ioctl */
2310 memset(parg
, 0, _IOC_SIZE(cmd
));
2314 err
= check_array_args(cmd
, parg
, &array_size
, &user_ptr
, &kernel_ptr
);
2317 has_array_args
= err
;
2319 if (has_array_args
) {
2321 * When adding new types of array args, make sure that the
2322 * parent argument to ioctl (which contains the pointer to the
2323 * array) fits into sbuf (so that mbuf will still remain
2324 * unused up to here).
2326 mbuf
= kmalloc(array_size
, GFP_KERNEL
);
2329 goto out_array_args
;
2331 if (copy_from_user(mbuf
, user_ptr
, array_size
))
2332 goto out_array_args
;
2337 err
= func(file
, cmd
, parg
);
2338 if (err
== -ENOIOCTLCMD
)
2341 if (has_array_args
) {
2342 *kernel_ptr
= user_ptr
;
2343 if (copy_to_user(user_ptr
, mbuf
, array_size
))
2345 goto out_array_args
;
2347 /* VIDIOC_QUERY_DV_TIMINGS can return an error, but still have valid
2348 results that must be returned. */
2349 if (err
< 0 && cmd
!= VIDIOC_QUERY_DV_TIMINGS
)
2353 /* Copy results into user buffer */
2354 switch (_IOC_DIR(cmd
)) {
2356 case (_IOC_WRITE
| _IOC_READ
):
2357 if (copy_to_user((void __user
*)arg
, parg
, _IOC_SIZE(cmd
)))
2366 EXPORT_SYMBOL(video_usercopy
);
2368 long video_ioctl2(struct file
*file
,
2369 unsigned int cmd
, unsigned long arg
)
2371 return video_usercopy(file
, cmd
, arg
, __video_do_ioctl
);
2373 EXPORT_SYMBOL(video_ioctl2
);