projects / linux-2.6-block.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
V4L/DVB: V4L: Events: Support event handling in do_ioctl
[linux-2.6-block.git] / drivers / media / video / v4l2-ioctl.c
CommitLineData
35ea11ff
HV		 1/*
2 * Video capture interface for Linux version 2
3 *
4 * A generic framework to process V4L2 ioctl commands.
5 *
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.
10 *
d9b01449 11 * Authors: Alan Cox, <alan@lxorguk.ukuu.org.uk> (version 1)
35ea11ff
HV		 12 * Mauro Carvalho Chehab <mchehab@infradead.org> (version 2)
13 */
14
15#include <linux/module.h>
5a0e3ad6 16#include <linux/slab.h>
35ea11ff
HV		 17#include <linux/types.h>
18#include <linux/kernel.h>
19
20#define __OLD_VIDIOC_ /* To allow fixing old calls */
7e0a16f6 21#include <linux/videodev.h>
35ea11ff
HV		 22#include <linux/videodev2.h>
23
24#ifdef CONFIG_VIDEO_V4L1
25#include <linux/videodev.h>
26#endif
27#include <media/v4l2-common.h>
28#include <media/v4l2-ioctl.h>
d3d7c963
SA		 29#include <media/v4l2-fh.h>
30#include <media/v4l2-event.h>
80b36e0f 31#include <media/v4l2-chip-ident.h>
35ea11ff
HV		 32
33#define dbgarg(cmd, fmt, arg...) \
34 do { \
35 if (vfd->debug & V4L2_DEBUG_IOCTL_ARG) { \
36 printk(KERN_DEBUG "%s: ", vfd->name); \
37 v4l_printk_ioctl(cmd); \
38 printk(" " fmt, ## arg); \
39 } \
40 } while (0)
41
42#define dbgarg2(fmt, arg...) \
43 do { \
44 if (vfd->debug & V4L2_DEBUG_IOCTL_ARG) \
45 printk(KERN_DEBUG "%s: " fmt, vfd->name, ## arg);\
46 } while (0)
47
d33fbcbb
MCC		 48#define dbgarg3(fmt, arg...) \
49 do { \
50 if (vfd->debug & V4L2_DEBUG_IOCTL_ARG) \
51 printk(KERN_CONT "%s: " fmt, vfd->name, ## arg);\
52 } while (0)
53
7ecc0cf9
TP		 54/* Zero out the end of the struct pointed to by p. Everthing after, but
55 * not including, the specified field is cleared. */
56#define CLEAR_AFTER_FIELD(p, field) \
57 memset((u8 *)(p) + offsetof(typeof(*(p)), field) + sizeof((p)->field), \
58 0, sizeof(*(p)) - offsetof(typeof(*(p)), field) - sizeof((p)->field))
59
35ea11ff
HV		 60struct std_descr {
61 v4l2_std_id std;
62 const char *descr;
63};
64
65static const struct std_descr standards[] = {
66 { V4L2_STD_NTSC, "NTSC" },
67 { V4L2_STD_NTSC_M, "NTSC-M" },
68 { V4L2_STD_NTSC_M_JP, "NTSC-M-JP" },
69 { V4L2_STD_NTSC_M_KR, "NTSC-M-KR" },
70 { V4L2_STD_NTSC_443, "NTSC-443" },
71 { V4L2_STD_PAL, "PAL" },
72 { V4L2_STD_PAL_BG, "PAL-BG" },
73 { V4L2_STD_PAL_B, "PAL-B" },
74 { V4L2_STD_PAL_B1, "PAL-B1" },
75 { V4L2_STD_PAL_G, "PAL-G" },
76 { V4L2_STD_PAL_H, "PAL-H" },
77 { V4L2_STD_PAL_I, "PAL-I" },
78 { V4L2_STD_PAL_DK, "PAL-DK" },
79 { V4L2_STD_PAL_D, "PAL-D" },
80 { V4L2_STD_PAL_D1, "PAL-D1" },
81 { V4L2_STD_PAL_K, "PAL-K" },
82 { V4L2_STD_PAL_M, "PAL-M" },
83 { V4L2_STD_PAL_N, "PAL-N" },
84 { V4L2_STD_PAL_Nc, "PAL-Nc" },
85 { V4L2_STD_PAL_60, "PAL-60" },
86 { V4L2_STD_SECAM, "SECAM" },
87 { V4L2_STD_SECAM_B, "SECAM-B" },
88 { V4L2_STD_SECAM_G, "SECAM-G" },
89 { V4L2_STD_SECAM_H, "SECAM-H" },
90 { V4L2_STD_SECAM_DK, "SECAM-DK" },
91 { V4L2_STD_SECAM_D, "SECAM-D" },
92 { V4L2_STD_SECAM_K, "SECAM-K" },
93 { V4L2_STD_SECAM_K1, "SECAM-K1" },
94 { V4L2_STD_SECAM_L, "SECAM-L" },
95 { V4L2_STD_SECAM_LC, "SECAM-Lc" },
96 { 0, "Unknown" }
97};
98
99/* video4linux standard ID conversion to standard name
100 */
101const char *v4l2_norm_to_name(v4l2_std_id id)
102{
103 u32 myid = id;
104 int i;
105
106 /* HACK: ppc32 architecture doesn't have __ucmpdi2 function to handle
107 64 bit comparations. So, on that architecture, with some gcc
108 variants, compilation fails. Currently, the max value is 30bit wide.
109 */
110 BUG_ON(myid != id);
111
112 for (i = 0; standards[i].std; i++)
113 if (myid == standards[i].std)
114 break;
115 return standards[i].descr;
116}
117EXPORT_SYMBOL(v4l2_norm_to_name);
118
51f0b8d5
TP		 119/* Returns frame period for the given standard */
120void v4l2_video_std_frame_period(int id, struct v4l2_fract *frameperiod)
121{
122 if (id & V4L2_STD_525_60) {
123 frameperiod->numerator = 1001;
124 frameperiod->denominator = 30000;
125 } else {
126 frameperiod->numerator = 1;
127 frameperiod->denominator = 25;
128 }
129}
130EXPORT_SYMBOL(v4l2_video_std_frame_period);
131
35ea11ff
HV		 132/* Fill in the fields of a v4l2_standard structure according to the
133 'id' and 'transmission' parameters. Returns negative on error. */
134int v4l2_video_std_construct(struct v4l2_standard *vs,
135 int id, const char *name)
136{
51f0b8d5
TP		 137 vs->id = id;
138 v4l2_video_std_frame_period(id, &vs->frameperiod);
139 vs->framelines = (id & V4L2_STD_525_60) ? 525 : 625;
35ea11ff
HV		 140 strlcpy(vs->name, name, sizeof(vs->name));
141 return 0;
142}
143EXPORT_SYMBOL(v4l2_video_std_construct);
144
145/* ----------------------------------------------------------------- */
146/* some arrays for pretty-printing debug messages of enum types */
147
148const char *v4l2_field_names[] = {
149 [V4L2_FIELD_ANY] = "any",
150 [V4L2_FIELD_NONE] = "none",
151 [V4L2_FIELD_TOP] = "top",
152 [V4L2_FIELD_BOTTOM] = "bottom",
153 [V4L2_FIELD_INTERLACED] = "interlaced",
154 [V4L2_FIELD_SEQ_TB] = "seq-tb",
155 [V4L2_FIELD_SEQ_BT] = "seq-bt",
156 [V4L2_FIELD_ALTERNATE] = "alternate",
157 [V4L2_FIELD_INTERLACED_TB] = "interlaced-tb",
158 [V4L2_FIELD_INTERLACED_BT] = "interlaced-bt",
159};
160EXPORT_SYMBOL(v4l2_field_names);
161
162const char *v4l2_type_names[] = {
163 [V4L2_BUF_TYPE_VIDEO_CAPTURE] = "vid-cap",
164 [V4L2_BUF_TYPE_VIDEO_OVERLAY] = "vid-overlay",
165 [V4L2_BUF_TYPE_VIDEO_OUTPUT] = "vid-out",
166 [V4L2_BUF_TYPE_VBI_CAPTURE] = "vbi-cap",
167 [V4L2_BUF_TYPE_VBI_OUTPUT] = "vbi-out",
168 [V4L2_BUF_TYPE_SLICED_VBI_CAPTURE] = "sliced-vbi-cap",
169 [V4L2_BUF_TYPE_SLICED_VBI_OUTPUT] = "sliced-vbi-out",
170 [V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY] = "vid-out-overlay",
171};
172EXPORT_SYMBOL(v4l2_type_names);
173
174static const char *v4l2_memory_names[] = {
175 [V4L2_MEMORY_MMAP] = "mmap",
176 [V4L2_MEMORY_USERPTR] = "userptr",
177 [V4L2_MEMORY_OVERLAY] = "overlay",
178};
179
180#define prt_names(a, arr) ((((a) >= 0) && ((a) < ARRAY_SIZE(arr))) ? \
181 arr[a] : "unknown")
182
183/* ------------------------------------------------------------------ */
184/* debug help functions */
185
186#ifdef CONFIG_VIDEO_V4L1_COMPAT
187static const char *v4l1_ioctls[] = {
188 [_IOC_NR(VIDIOCGCAP)] = "VIDIOCGCAP",
189 [_IOC_NR(VIDIOCGCHAN)] = "VIDIOCGCHAN",
190 [_IOC_NR(VIDIOCSCHAN)] = "VIDIOCSCHAN",
191 [_IOC_NR(VIDIOCGTUNER)] = "VIDIOCGTUNER",
192 [_IOC_NR(VIDIOCSTUNER)] = "VIDIOCSTUNER",
193 [_IOC_NR(VIDIOCGPICT)] = "VIDIOCGPICT",
194 [_IOC_NR(VIDIOCSPICT)] = "VIDIOCSPICT",
195 [_IOC_NR(VIDIOCCAPTURE)] = "VIDIOCCAPTURE",
196 [_IOC_NR(VIDIOCGWIN)] = "VIDIOCGWIN",
197 [_IOC_NR(VIDIOCSWIN)] = "VIDIOCSWIN",
198 [_IOC_NR(VIDIOCGFBUF)] = "VIDIOCGFBUF",
199 [_IOC_NR(VIDIOCSFBUF)] = "VIDIOCSFBUF",
200 [_IOC_NR(VIDIOCKEY)] = "VIDIOCKEY",
201 [_IOC_NR(VIDIOCGFREQ)] = "VIDIOCGFREQ",
202 [_IOC_NR(VIDIOCSFREQ)] = "VIDIOCSFREQ",
203 [_IOC_NR(VIDIOCGAUDIO)] = "VIDIOCGAUDIO",
204 [_IOC_NR(VIDIOCSAUDIO)] = "VIDIOCSAUDIO",
205 [_IOC_NR(VIDIOCSYNC)] = "VIDIOCSYNC",
206 [_IOC_NR(VIDIOCMCAPTURE)] = "VIDIOCMCAPTURE",
207 [_IOC_NR(VIDIOCGMBUF)] = "VIDIOCGMBUF",
208 [_IOC_NR(VIDIOCGUNIT)] = "VIDIOCGUNIT",
209 [_IOC_NR(VIDIOCGCAPTURE)] = "VIDIOCGCAPTURE",
210 [_IOC_NR(VIDIOCSCAPTURE)] = "VIDIOCSCAPTURE",
211 [_IOC_NR(VIDIOCSPLAYMODE)] = "VIDIOCSPLAYMODE",
212 [_IOC_NR(VIDIOCSWRITEMODE)] = "VIDIOCSWRITEMODE",
213 [_IOC_NR(VIDIOCGPLAYINFO)] = "VIDIOCGPLAYINFO",
214 [_IOC_NR(VIDIOCSMICROCODE)] = "VIDIOCSMICROCODE",
215 [_IOC_NR(VIDIOCGVBIFMT)] = "VIDIOCGVBIFMT",
216 [_IOC_NR(VIDIOCSVBIFMT)] = "VIDIOCSVBIFMT"
217};
218#define V4L1_IOCTLS ARRAY_SIZE(v4l1_ioctls)
219#endif
220
221static const char *v4l2_ioctls[] = {
222 [_IOC_NR(VIDIOC_QUERYCAP)] = "VIDIOC_QUERYCAP",
223 [_IOC_NR(VIDIOC_RESERVED)] = "VIDIOC_RESERVED",
224 [_IOC_NR(VIDIOC_ENUM_FMT)] = "VIDIOC_ENUM_FMT",
225 [_IOC_NR(VIDIOC_G_FMT)] = "VIDIOC_G_FMT",
226 [_IOC_NR(VIDIOC_S_FMT)] = "VIDIOC_S_FMT",
227 [_IOC_NR(VIDIOC_REQBUFS)] = "VIDIOC_REQBUFS",
228 [_IOC_NR(VIDIOC_QUERYBUF)] = "VIDIOC_QUERYBUF",
229 [_IOC_NR(VIDIOC_G_FBUF)] = "VIDIOC_G_FBUF",
230 [_IOC_NR(VIDIOC_S_FBUF)] = "VIDIOC_S_FBUF",
231 [_IOC_NR(VIDIOC_OVERLAY)] = "VIDIOC_OVERLAY",
232 [_IOC_NR(VIDIOC_QBUF)] = "VIDIOC_QBUF",
233 [_IOC_NR(VIDIOC_DQBUF)] = "VIDIOC_DQBUF",
234 [_IOC_NR(VIDIOC_STREAMON)] = "VIDIOC_STREAMON",
235 [_IOC_NR(VIDIOC_STREAMOFF)] = "VIDIOC_STREAMOFF",
236 [_IOC_NR(VIDIOC_G_PARM)] = "VIDIOC_G_PARM",
237 [_IOC_NR(VIDIOC_S_PARM)] = "VIDIOC_S_PARM",
238 [_IOC_NR(VIDIOC_G_STD)] = "VIDIOC_G_STD",
239 [_IOC_NR(VIDIOC_S_STD)] = "VIDIOC_S_STD",
240 [_IOC_NR(VIDIOC_ENUMSTD)] = "VIDIOC_ENUMSTD",
241 [_IOC_NR(VIDIOC_ENUMINPUT)] = "VIDIOC_ENUMINPUT",
242 [_IOC_NR(VIDIOC_G_CTRL)] = "VIDIOC_G_CTRL",
243 [_IOC_NR(VIDIOC_S_CTRL)] = "VIDIOC_S_CTRL",
244 [_IOC_NR(VIDIOC_G_TUNER)] = "VIDIOC_G_TUNER",
245 [_IOC_NR(VIDIOC_S_TUNER)] = "VIDIOC_S_TUNER",
246 [_IOC_NR(VIDIOC_G_AUDIO)] = "VIDIOC_G_AUDIO",
247 [_IOC_NR(VIDIOC_S_AUDIO)] = "VIDIOC_S_AUDIO",
248 [_IOC_NR(VIDIOC_QUERYCTRL)] = "VIDIOC_QUERYCTRL",
249 [_IOC_NR(VIDIOC_QUERYMENU)] = "VIDIOC_QUERYMENU",
250 [_IOC_NR(VIDIOC_G_INPUT)] = "VIDIOC_G_INPUT",
251 [_IOC_NR(VIDIOC_S_INPUT)] = "VIDIOC_S_INPUT",
252 [_IOC_NR(VIDIOC_G_OUTPUT)] = "VIDIOC_G_OUTPUT",
253 [_IOC_NR(VIDIOC_S_OUTPUT)] = "VIDIOC_S_OUTPUT",
254 [_IOC_NR(VIDIOC_ENUMOUTPUT)] = "VIDIOC_ENUMOUTPUT",
255 [_IOC_NR(VIDIOC_G_AUDOUT)] = "VIDIOC_G_AUDOUT",
256 [_IOC_NR(VIDIOC_S_AUDOUT)] = "VIDIOC_S_AUDOUT",
257 [_IOC_NR(VIDIOC_G_MODULATOR)] = "VIDIOC_G_MODULATOR",
258 [_IOC_NR(VIDIOC_S_MODULATOR)] = "VIDIOC_S_MODULATOR",
259 [_IOC_NR(VIDIOC_G_FREQUENCY)] = "VIDIOC_G_FREQUENCY",
260 [_IOC_NR(VIDIOC_S_FREQUENCY)] = "VIDIOC_S_FREQUENCY",
261 [_IOC_NR(VIDIOC_CROPCAP)] = "VIDIOC_CROPCAP",
262 [_IOC_NR(VIDIOC_G_CROP)] = "VIDIOC_G_CROP",
263 [_IOC_NR(VIDIOC_S_CROP)] = "VIDIOC_S_CROP",
264 [_IOC_NR(VIDIOC_G_JPEGCOMP)] = "VIDIOC_G_JPEGCOMP",
265 [_IOC_NR(VIDIOC_S_JPEGCOMP)] = "VIDIOC_S_JPEGCOMP",
266 [_IOC_NR(VIDIOC_QUERYSTD)] = "VIDIOC_QUERYSTD",
267 [_IOC_NR(VIDIOC_TRY_FMT)] = "VIDIOC_TRY_FMT",
268 [_IOC_NR(VIDIOC_ENUMAUDIO)] = "VIDIOC_ENUMAUDIO",
269 [_IOC_NR(VIDIOC_ENUMAUDOUT)] = "VIDIOC_ENUMAUDOUT",
270 [_IOC_NR(VIDIOC_G_PRIORITY)] = "VIDIOC_G_PRIORITY",
271 [_IOC_NR(VIDIOC_S_PRIORITY)] = "VIDIOC_S_PRIORITY",
272 [_IOC_NR(VIDIOC_G_SLICED_VBI_CAP)] = "VIDIOC_G_SLICED_VBI_CAP",
273 [_IOC_NR(VIDIOC_LOG_STATUS)] = "VIDIOC_LOG_STATUS",
274 [_IOC_NR(VIDIOC_G_EXT_CTRLS)] = "VIDIOC_G_EXT_CTRLS",
275 [_IOC_NR(VIDIOC_S_EXT_CTRLS)] = "VIDIOC_S_EXT_CTRLS",
276 [_IOC_NR(VIDIOC_TRY_EXT_CTRLS)] = "VIDIOC_TRY_EXT_CTRLS",
277#if 1
278 [_IOC_NR(VIDIOC_ENUM_FRAMESIZES)] = "VIDIOC_ENUM_FRAMESIZES",
279 [_IOC_NR(VIDIOC_ENUM_FRAMEINTERVALS)] = "VIDIOC_ENUM_FRAMEINTERVALS",
280 [_IOC_NR(VIDIOC_G_ENC_INDEX)] = "VIDIOC_G_ENC_INDEX",
281 [_IOC_NR(VIDIOC_ENCODER_CMD)] = "VIDIOC_ENCODER_CMD",
282 [_IOC_NR(VIDIOC_TRY_ENCODER_CMD)] = "VIDIOC_TRY_ENCODER_CMD",
283
284 [_IOC_NR(VIDIOC_DBG_S_REGISTER)] = "VIDIOC_DBG_S_REGISTER",
285 [_IOC_NR(VIDIOC_DBG_G_REGISTER)] = "VIDIOC_DBG_G_REGISTER",
286
aecde8b5 287 [_IOC_NR(VIDIOC_DBG_G_CHIP_IDENT)] = "VIDIOC_DBG_G_CHIP_IDENT",
35ea11ff
HV		 288 [_IOC_NR(VIDIOC_S_HW_FREQ_SEEK)] = "VIDIOC_S_HW_FREQ_SEEK",
289#endif
b6456c0c
MK		 290 [_IOC_NR(VIDIOC_ENUM_DV_PRESETS)] = "VIDIOC_ENUM_DV_PRESETS",
291 [_IOC_NR(VIDIOC_S_DV_PRESET)] = "VIDIOC_S_DV_PRESET",
292 [_IOC_NR(VIDIOC_G_DV_PRESET)] = "VIDIOC_G_DV_PRESET",
293 [_IOC_NR(VIDIOC_QUERY_DV_PRESET)] = "VIDIOC_QUERY_DV_PRESET",
294 [_IOC_NR(VIDIOC_S_DV_TIMINGS)] = "VIDIOC_S_DV_TIMINGS",
295 [_IOC_NR(VIDIOC_G_DV_TIMINGS)] = "VIDIOC_G_DV_TIMINGS",
fda10214
SA		 296 [_IOC_NR(VIDIOC_DQEVENT)] = "VIDIOC_DQEVENT",
297 [_IOC_NR(VIDIOC_SUBSCRIBE_EVENT)] = "VIDIOC_SUBSCRIBE_EVENT",
298 [_IOC_NR(VIDIOC_UNSUBSCRIBE_EVENT)] = "VIDIOC_UNSUBSCRIBE_EVENT",
35ea11ff
HV		 299};
300#define V4L2_IOCTLS ARRAY_SIZE(v4l2_ioctls)
301
35ea11ff
HV		 302/* Common ioctl debug function. This function can be used by
303 external ioctl messages as well as internal V4L ioctl */
304void v4l_printk_ioctl(unsigned int cmd)
305{
306 char *dir, *type;
307
308 switch (_IOC_TYPE(cmd)) {
309 case 'd':
78a3b4db
HV		 310 type = "v4l2_int";
311 break;
35ea11ff
HV		 312#ifdef CONFIG_VIDEO_V4L1_COMPAT
313 case 'v':
314 if (_IOC_NR(cmd) >= V4L1_IOCTLS) {
315 type = "v4l1";
316 break;
317 }
318 printk("%s", v4l1_ioctls[_IOC_NR(cmd)]);
319 return;
320#endif
321 case 'V':
322 if (_IOC_NR(cmd) >= V4L2_IOCTLS) {
323 type = "v4l2";
324 break;
325 }
326 printk("%s", v4l2_ioctls[_IOC_NR(cmd)]);
327 return;
328 default:
329 type = "unknown";
330 }
331
332 switch (_IOC_DIR(cmd)) {
333 case _IOC_NONE: dir = "--"; break;
334 case _IOC_READ: dir = "r-"; break;
335 case _IOC_WRITE: dir = "-w"; break;
336 case _IOC_READ | _IOC_WRITE: dir = "rw"; break;
337 default: dir = "*ERR*"; break;
338 }
339 printk("%s ioctl '%c', dir=%s, #%d (0x%08x)",
340 type, _IOC_TYPE(cmd), dir, _IOC_NR(cmd), cmd);
341}
342EXPORT_SYMBOL(v4l_printk_ioctl);
343
344/*
345 * helper function -- handles userspace copying for ioctl arguments
346 */
347
348#ifdef __OLD_VIDIOC_
349static unsigned int
350video_fix_command(unsigned int cmd)
351{
352 switch (cmd) {
353 case VIDIOC_OVERLAY_OLD:
354 cmd = VIDIOC_OVERLAY;
355 break;
356 case VIDIOC_S_PARM_OLD:
357 cmd = VIDIOC_S_PARM;
358 break;
359 case VIDIOC_S_CTRL_OLD:
360 cmd = VIDIOC_S_CTRL;
361 break;
362 case VIDIOC_G_AUDIO_OLD:
363 cmd = VIDIOC_G_AUDIO;
364 break;
365 case VIDIOC_G_AUDOUT_OLD:
366 cmd = VIDIOC_G_AUDOUT;
367 break;
368 case VIDIOC_CROPCAP_OLD:
369 cmd = VIDIOC_CROPCAP;
370 break;
371 }
372 return cmd;
373}
374#endif
375
376/*
377 * Obsolete usercopy function - Should be removed soon
378 */
069b7479 379long
f473bf76
HV		 380video_usercopy(struct file *file, unsigned int cmd, unsigned long arg,
381 v4l2_kioctl func)
35ea11ff
HV		 382{
383 char sbuf[128];
384 void *mbuf = NULL;
385 void *parg = NULL;
069b7479 386 long err = -EINVAL;
35ea11ff
HV		 387 int is_ext_ctrl;
388 size_t ctrls_size = 0;
389 void __user *user_ptr = NULL;
390
391#ifdef __OLD_VIDIOC_
392 cmd = video_fix_command(cmd);
393#endif
394 is_ext_ctrl = (cmd == VIDIOC_S_EXT_CTRLS || cmd == VIDIOC_G_EXT_CTRLS ||
395 cmd == VIDIOC_TRY_EXT_CTRLS);
396
397 /* Copy arguments into temp kernel buffer */
398 switch (_IOC_DIR(cmd)) {
399 case _IOC_NONE:
400 parg = NULL;
401 break;
402 case _IOC_READ:
403 case _IOC_WRITE:
404 case (_IOC_WRITE | _IOC_READ):
405 if (_IOC_SIZE(cmd) <= sizeof(sbuf)) {
406 parg = sbuf;
407 } else {
408 /* too big to allocate from stack */
409 mbuf = kmalloc(_IOC_SIZE(cmd), GFP_KERNEL);
410 if (NULL == mbuf)
411 return -ENOMEM;
412 parg = mbuf;
413 }
414
415 err = -EFAULT;
416 if (_IOC_DIR(cmd) & _IOC_WRITE)
417 if (copy_from_user(parg, (void __user *)arg, _IOC_SIZE(cmd)))
418 goto out;
419 break;
420 }
421 if (is_ext_ctrl) {
422 struct v4l2_ext_controls *p = parg;
423
424 /* In case of an error, tell the caller that it wasn't
425 a specific control that caused it. */
426 p->error_idx = p->count;
427 user_ptr = (void __user *)p->controls;
428 if (p->count) {
429 ctrls_size = sizeof(struct v4l2_ext_control) * p->count;
430 /* Note: v4l2_ext_controls fits in sbuf[] so mbuf is still NULL. */
431 mbuf = kmalloc(ctrls_size, GFP_KERNEL);
432 err = -ENOMEM;
433 if (NULL == mbuf)
434 goto out_ext_ctrl;
435 err = -EFAULT;
436 if (copy_from_user(mbuf, user_ptr, ctrls_size))
437 goto out_ext_ctrl;
438 p->controls = mbuf;
439 }
440 }
441
442 /* call driver */
f473bf76 443 err = func(file, cmd, parg);
35ea11ff
HV		 444 if (err == -ENOIOCTLCMD)
445 err = -EINVAL;
446 if (is_ext_ctrl) {
447 struct v4l2_ext_controls *p = parg;
448
449 p->controls = (void *)user_ptr;
450 if (p->count && err == 0 && copy_to_user(user_ptr, mbuf, ctrls_size))
451 err = -EFAULT;
452 goto out_ext_ctrl;
453 }
454 if (err < 0)
455 goto out;
456
457out_ext_ctrl:
458 /* Copy results into user buffer */
459 switch (_IOC_DIR(cmd)) {
460 case _IOC_READ:
461 case (_IOC_WRITE | _IOC_READ):
462 if (copy_to_user((void __user *)arg, parg, _IOC_SIZE(cmd)))
463 err = -EFAULT;
464 break;
465 }
466
467out:
468 kfree(mbuf);
469 return err;
470}
471EXPORT_SYMBOL(video_usercopy);
472
473static void dbgbuf(unsigned int cmd, struct video_device *vfd,
474 struct v4l2_buffer *p)
475{
476 struct v4l2_timecode *tc = &p->timecode;
477
478 dbgarg(cmd, "%02ld:%02d:%02d.%08ld index=%d, type=%s, "
479 "bytesused=%d, flags=0x%08d, "
480 "field=%0d, sequence=%d, memory=%s, offset/userptr=0x%08lx, length=%d\n",
481 p->timestamp.tv_sec / 3600,
482 (int)(p->timestamp.tv_sec / 60) % 60,
483 (int)(p->timestamp.tv_sec % 60),
b045979d 484 (long)p->timestamp.tv_usec,
35ea11ff
HV		 485 p->index,
486 prt_names(p->type, v4l2_type_names),
487 p->bytesused, p->flags,
488 p->field, p->sequence,
489 prt_names(p->memory, v4l2_memory_names),
490 p->m.userptr, p->length);
491 dbgarg2("timecode=%02d:%02d:%02d type=%d, "
492 "flags=0x%08d, frames=%d, userbits=0x%08x\n",
493 tc->hours, tc->minutes, tc->seconds,
494 tc->type, tc->flags, tc->frames, *(__u32 *)tc->userbits);
495}
496
497static inline void dbgrect(struct video_device *vfd, char *s,
498 struct v4l2_rect *r)
499{
500 dbgarg2("%sRect start at %dx%d, size=%dx%d\n", s, r->left, r->top,
501 r->width, r->height);
502};
503
504static inline void v4l_print_pix_fmt(struct video_device *vfd,
505 struct v4l2_pix_format *fmt)
506{
507 dbgarg2("width=%d, height=%d, format=%c%c%c%c, field=%s, "
508 "bytesperline=%d sizeimage=%d, colorspace=%d\n",
509 fmt->width, fmt->height,
510 (fmt->pixelformat & 0xff),
511 (fmt->pixelformat >> 8) & 0xff,
512 (fmt->pixelformat >> 16) & 0xff,
513 (fmt->pixelformat >> 24) & 0xff,
514 prt_names(fmt->field, v4l2_field_names),
515 fmt->bytesperline, fmt->sizeimage, fmt->colorspace);
516};
517
518static inline void v4l_print_ext_ctrls(unsigned int cmd,
519 struct video_device *vfd, struct v4l2_ext_controls *c, int show_vals)
520{
521 __u32 i;
522
523 if (!(vfd->debug & V4L2_DEBUG_IOCTL_ARG))
524 return;
525 dbgarg(cmd, "");
526 printk(KERN_CONT "class=0x%x", c->ctrl_class);
527 for (i = 0; i < c->count; i++) {
6b5a9492 528 if (show_vals && !c->controls[i].size)
35ea11ff
HV		 529 printk(KERN_CONT " id/val=0x%x/0x%x",
530 c->controls[i].id, c->controls[i].value);
531 else
6b5a9492
HV		 532 printk(KERN_CONT " id=0x%x,size=%u",
533 c->controls[i].id, c->controls[i].size);
35ea11ff
HV		 534 }
535 printk(KERN_CONT "\n");
536};
537
538static inline int check_ext_ctrls(struct v4l2_ext_controls *c, int allow_priv)
539{
540 __u32 i;
541
542 /* zero the reserved fields */
543 c->reserved[0] = c->reserved[1] = 0;
6b5a9492 544 for (i = 0; i < c->count; i++)
35ea11ff 545 c->controls[i].reserved2[0] = 0;
6b5a9492 546
35ea11ff
HV		 547 /* V4L2_CID_PRIVATE_BASE cannot be used as control class
548 when using extended controls.
549 Only when passed in through VIDIOC_G_CTRL and VIDIOC_S_CTRL
550 is it allowed for backwards compatibility.
551 */
552 if (!allow_priv && c->ctrl_class == V4L2_CID_PRIVATE_BASE)
553 return 0;
554 /* Check that all controls are from the same control class. */
555 for (i = 0; i < c->count; i++) {
556 if (V4L2_CTRL_ID2CLASS(c->controls[i].id) != c->ctrl_class) {
557 c->error_idx = i;
558 return 0;
559 }
560 }
561 return 1;
562}
563
a399810c 564static int check_fmt(const struct v4l2_ioctl_ops *ops, enum v4l2_buf_type type)
35ea11ff 565{
a399810c
HV		 566 if (ops == NULL)
567 return -EINVAL;
568
35ea11ff
HV		 569 switch (type) {
570 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
1175d613 571 if (ops->vidioc_g_fmt_vid_cap)
35ea11ff
HV		 572 return 0;
573 break;
574 case V4L2_BUF_TYPE_VIDEO_OVERLAY:
1175d613 575 if (ops->vidioc_g_fmt_vid_overlay)
35ea11ff
HV		 576 return 0;
577 break;
578 case V4L2_BUF_TYPE_VIDEO_OUTPUT:
1175d613 579 if (ops->vidioc_g_fmt_vid_out)
35ea11ff
HV		 580 return 0;
581 break;
582 case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
1175d613 583 if (ops->vidioc_g_fmt_vid_out_overlay)
35ea11ff
HV		 584 return 0;
585 break;
586 case V4L2_BUF_TYPE_VBI_CAPTURE:
1175d613 587 if (ops->vidioc_g_fmt_vbi_cap)
35ea11ff
HV		 588 return 0;
589 break;
590 case V4L2_BUF_TYPE_VBI_OUTPUT:
1175d613 591 if (ops->vidioc_g_fmt_vbi_out)
35ea11ff
HV		 592 return 0;
593 break;
594 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
1175d613 595 if (ops->vidioc_g_fmt_sliced_vbi_cap)
35ea11ff
HV		 596 return 0;
597 break;
598 case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
1175d613 599 if (ops->vidioc_g_fmt_sliced_vbi_out)
35ea11ff
HV		 600 return 0;
601 break;
602 case V4L2_BUF_TYPE_PRIVATE:
1175d613 603 if (ops->vidioc_g_fmt_type_private)
35ea11ff
HV		 604 return 0;
605 break;
606 }
607 return -EINVAL;
608}
609
069b7479 610static long __video_do_ioctl(struct file *file,
35ea11ff
HV		 611 unsigned int cmd, void *arg)
612{
613 struct video_device *vfd = video_devdata(file);
a399810c 614 const struct v4l2_ioctl_ops *ops = vfd->ioctl_ops;
d5fbf32f 615 void *fh = file->private_data;
069b7479 616 long ret = -EINVAL;
35ea11ff 617
6a717883
HV		 618 if (ops == NULL) {
619 printk(KERN_WARNING "videodev: \"%s\" has no ioctl_ops.\n",
620 vfd->name);
621 return -EINVAL;
622 }
623
624#ifdef CONFIG_VIDEO_V4L1_COMPAT
625 /********************************************************
626 All other V4L1 calls are handled by v4l1_compat module.
627 Those calls will be translated into V4L2 calls, and
628 __video_do_ioctl will be called again, with one or more
629 V4L2 ioctls.
630 ********************************************************/
631 if (_IOC_TYPE(cmd) == 'v' && cmd != VIDIOCGMBUF &&
632 _IOC_NR(cmd) < BASE_VIDIOCPRIVATE) {
633 return v4l_compat_translate_ioctl(file, cmd, arg,
634 __video_do_ioctl);
635 }
636#endif
637
35ea11ff
HV		 638 if ((vfd->debug & V4L2_DEBUG_IOCTL) &&
639 !(vfd->debug & V4L2_DEBUG_IOCTL_ARG)) {
640 v4l_print_ioctl(vfd->name, cmd);
641 printk(KERN_CONT "\n");
642 }
643
6a717883 644 switch (cmd) {
a399810c 645
35ea11ff
HV		 646#ifdef CONFIG_VIDEO_V4L1_COMPAT
647 /***********************************************************
648 Handles calls to the obsoleted V4L1 API
649 Due to the nature of VIDIOCGMBUF, each driver that supports
650 V4L1 should implement its own handler for this ioctl.
651 ***********************************************************/
652
653 /* --- streaming capture ------------------------------------- */
6a717883
HV		 654 case VIDIOCGMBUF:
655 {
35ea11ff
HV		 656 struct video_mbuf *p = arg;
657
a399810c 658 if (!ops->vidiocgmbuf)
6a717883 659 break;
a399810c 660 ret = ops->vidiocgmbuf(file, fh, p);
35ea11ff
HV		 661 if (!ret)
662 dbgarg(cmd, "size=%d, frames=%d, offsets=0x%08lx\n",
663 p->size, p->frames,
664 (unsigned long)p->offsets);
6a717883 665 break;
35ea11ff 666 }
35ea11ff
HV		 667#endif
668
35ea11ff
HV		 669 /* --- capabilities ------------------------------------------ */
670 case VIDIOC_QUERYCAP:
671 {
672 struct v4l2_capability *cap = (struct v4l2_capability *)arg;
35ea11ff 673
a399810c 674 if (!ops->vidioc_querycap)
35ea11ff
HV		 675 break;
676
a399810c 677 ret = ops->vidioc_querycap(file, fh, cap);
35ea11ff
HV		 678 if (!ret)
679 dbgarg(cmd, "driver=%s, card=%s, bus=%s, "
680 "version=0x%08x, "
681 "capabilities=0x%08x\n",
682 cap->driver, cap->card, cap->bus_info,
683 cap->version,
684 cap->capabilities);
685 break;
686 }
687
688 /* --- priority ------------------------------------------ */
689 case VIDIOC_G_PRIORITY:
690 {
691 enum v4l2_priority *p = arg;
692
a399810c 693 if (!ops->vidioc_g_priority)
35ea11ff 694 break;
a399810c 695 ret = ops->vidioc_g_priority(file, fh, p);
35ea11ff
HV		 696 if (!ret)
697 dbgarg(cmd, "priority is %d\n", *p);
698 break;
699 }
700 case VIDIOC_S_PRIORITY:
701 {
702 enum v4l2_priority *p = arg;
703
a399810c 704 if (!ops->vidioc_s_priority)
35ea11ff
HV		 705 break;
706 dbgarg(cmd, "setting priority to %d\n", *p);
a399810c 707 ret = ops->vidioc_s_priority(file, fh, *p);
35ea11ff
HV		 708 break;
709 }
710
711 /* --- capture ioctls ---------------------------------------- */
712 case VIDIOC_ENUM_FMT:
713 {
714 struct v4l2_fmtdesc *f = arg;
35ea11ff 715
19c96e4b 716 switch (f->type) {
35ea11ff 717 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
a399810c
HV		 718 if (ops->vidioc_enum_fmt_vid_cap)
719 ret = ops->vidioc_enum_fmt_vid_cap(file, fh, f);
35ea11ff
HV		 720 break;
721 case V4L2_BUF_TYPE_VIDEO_OVERLAY:
a399810c
HV		 722 if (ops->vidioc_enum_fmt_vid_overlay)
723 ret = ops->vidioc_enum_fmt_vid_overlay(file,
35ea11ff
HV		 724 fh, f);
725 break;
35ea11ff 726 case V4L2_BUF_TYPE_VIDEO_OUTPUT:
a399810c
HV		 727 if (ops->vidioc_enum_fmt_vid_out)
728 ret = ops->vidioc_enum_fmt_vid_out(file, fh, f);
35ea11ff
HV		 729 break;
730 case V4L2_BUF_TYPE_PRIVATE:
a399810c
HV		 731 if (ops->vidioc_enum_fmt_type_private)
732 ret = ops->vidioc_enum_fmt_type_private(file,
35ea11ff
HV		 733 fh, f);
734 break;
735 default:
736 break;
737 }
738 if (!ret)
739 dbgarg(cmd, "index=%d, type=%d, flags=%d, "
740 "pixelformat=%c%c%c%c, description='%s'\n",
741 f->index, f->type, f->flags,
742 (f->pixelformat & 0xff),
743 (f->pixelformat >> 8) & 0xff,
744 (f->pixelformat >> 16) & 0xff,
745 (f->pixelformat >> 24) & 0xff,
746 f->description);
747 break;
748 }
749 case VIDIOC_G_FMT:
750 {
751 struct v4l2_format *f = (struct v4l2_format *)arg;
752
35ea11ff
HV		 753 /* FIXME: Should be one dump per type */
754 dbgarg(cmd, "type=%s\n", prt_names(f->type, v4l2_type_names));
755
756 switch (f->type) {
757 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
a399810c
HV		 758 if (ops->vidioc_g_fmt_vid_cap)
759 ret = ops->vidioc_g_fmt_vid_cap(file, fh, f);
35ea11ff
HV		 760 if (!ret)
761 v4l_print_pix_fmt(vfd, &f->fmt.pix);
762 break;
763 case V4L2_BUF_TYPE_VIDEO_OVERLAY:
a399810c
HV		 764 if (ops->vidioc_g_fmt_vid_overlay)
765 ret = ops->vidioc_g_fmt_vid_overlay(file,
35ea11ff
HV		 766 fh, f);
767 break;
768 case V4L2_BUF_TYPE_VIDEO_OUTPUT:
a399810c
HV		 769 if (ops->vidioc_g_fmt_vid_out)
770 ret = ops->vidioc_g_fmt_vid_out(file, fh, f);
35ea11ff
HV		 771 if (!ret)
772 v4l_print_pix_fmt(vfd, &f->fmt.pix);
773 break;
774 case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
a399810c
HV		 775 if (ops->vidioc_g_fmt_vid_out_overlay)
776 ret = ops->vidioc_g_fmt_vid_out_overlay(file,
35ea11ff
HV		 777 fh, f);
778 break;
779 case V4L2_BUF_TYPE_VBI_CAPTURE:
a399810c
HV		 780 if (ops->vidioc_g_fmt_vbi_cap)
781 ret = ops->vidioc_g_fmt_vbi_cap(file, fh, f);
35ea11ff
HV		 782 break;
783 case V4L2_BUF_TYPE_VBI_OUTPUT:
a399810c
HV		 784 if (ops->vidioc_g_fmt_vbi_out)
785 ret = ops->vidioc_g_fmt_vbi_out(file, fh, f);
35ea11ff
HV		 786 break;
787 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
a399810c
HV		 788 if (ops->vidioc_g_fmt_sliced_vbi_cap)
789 ret = ops->vidioc_g_fmt_sliced_vbi_cap(file,
35ea11ff
HV		 790 fh, f);
791 break;
792 case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
a399810c
HV		 793 if (ops->vidioc_g_fmt_sliced_vbi_out)
794 ret = ops->vidioc_g_fmt_sliced_vbi_out(file,
35ea11ff
HV		 795 fh, f);
796 break;
797 case V4L2_BUF_TYPE_PRIVATE:
a399810c
HV		 798 if (ops->vidioc_g_fmt_type_private)
799 ret = ops->vidioc_g_fmt_type_private(file,
35ea11ff
HV		 800 fh, f);
801 break;
802 }
803
804 break;
805 }
806 case VIDIOC_S_FMT:
807 {
808 struct v4l2_format *f = (struct v4l2_format *)arg;
809
810 /* FIXME: Should be one dump per type */
811 dbgarg(cmd, "type=%s\n", prt_names(f->type, v4l2_type_names));
812
813 switch (f->type) {
814 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
7ecc0cf9 815 CLEAR_AFTER_FIELD(f, fmt.pix);
35ea11ff 816 v4l_print_pix_fmt(vfd, &f->fmt.pix);
a399810c
HV		 817 if (ops->vidioc_s_fmt_vid_cap)
818 ret = ops->vidioc_s_fmt_vid_cap(file, fh, f);
35ea11ff
HV		 819 break;
820 case V4L2_BUF_TYPE_VIDEO_OVERLAY:
7ecc0cf9 821 CLEAR_AFTER_FIELD(f, fmt.win);
a399810c
HV		 822 if (ops->vidioc_s_fmt_vid_overlay)
823 ret = ops->vidioc_s_fmt_vid_overlay(file,
35ea11ff
HV		 824 fh, f);
825 break;
826 case V4L2_BUF_TYPE_VIDEO_OUTPUT:
7ecc0cf9 827 CLEAR_AFTER_FIELD(f, fmt.pix);
35ea11ff 828 v4l_print_pix_fmt(vfd, &f->fmt.pix);
a399810c
HV		 829 if (ops->vidioc_s_fmt_vid_out)
830 ret = ops->vidioc_s_fmt_vid_out(file, fh, f);
35ea11ff
HV		 831 break;
832 case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
7ecc0cf9 833 CLEAR_AFTER_FIELD(f, fmt.win);
a399810c
HV		 834 if (ops->vidioc_s_fmt_vid_out_overlay)
835 ret = ops->vidioc_s_fmt_vid_out_overlay(file,
35ea11ff
HV		 836 fh, f);
837 break;
838 case V4L2_BUF_TYPE_VBI_CAPTURE:
7ecc0cf9 839 CLEAR_AFTER_FIELD(f, fmt.vbi);
a399810c
HV		 840 if (ops->vidioc_s_fmt_vbi_cap)
841 ret = ops->vidioc_s_fmt_vbi_cap(file, fh, f);
35ea11ff
HV		 842 break;
843 case V4L2_BUF_TYPE_VBI_OUTPUT:
7ecc0cf9 844 CLEAR_AFTER_FIELD(f, fmt.vbi);
a399810c
HV		 845 if (ops->vidioc_s_fmt_vbi_out)
846 ret = ops->vidioc_s_fmt_vbi_out(file, fh, f);
35ea11ff
HV		 847 break;
848 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
7ecc0cf9 849 CLEAR_AFTER_FIELD(f, fmt.sliced);
a399810c
HV		 850 if (ops->vidioc_s_fmt_sliced_vbi_cap)
851 ret = ops->vidioc_s_fmt_sliced_vbi_cap(file,
35ea11ff
HV		 852 fh, f);
853 break;
854 case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
7ecc0cf9 855 CLEAR_AFTER_FIELD(f, fmt.sliced);
a399810c
HV		 856 if (ops->vidioc_s_fmt_sliced_vbi_out)
857 ret = ops->vidioc_s_fmt_sliced_vbi_out(file,
35ea11ff
HV		 858 fh, f);
859 break;
860 case V4L2_BUF_TYPE_PRIVATE:
7ecc0cf9 861 /* CLEAR_AFTER_FIELD(f, fmt.raw_data); <- does nothing */
a399810c
HV		 862 if (ops->vidioc_s_fmt_type_private)
863 ret = ops->vidioc_s_fmt_type_private(file,
35ea11ff
HV		 864 fh, f);
865 break;
866 }
867 break;
868 }
869 case VIDIOC_TRY_FMT:
870 {
871 struct v4l2_format *f = (struct v4l2_format *)arg;
872
873 /* FIXME: Should be one dump per type */
874 dbgarg(cmd, "type=%s\n", prt_names(f->type,
875 v4l2_type_names));
876 switch (f->type) {
877 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
7ecc0cf9 878 CLEAR_AFTER_FIELD(f, fmt.pix);
a399810c
HV		 879 if (ops->vidioc_try_fmt_vid_cap)
880 ret = ops->vidioc_try_fmt_vid_cap(file, fh, f);
35ea11ff
HV		 881 if (!ret)
882 v4l_print_pix_fmt(vfd, &f->fmt.pix);
883 break;
884 case V4L2_BUF_TYPE_VIDEO_OVERLAY:
7ecc0cf9 885 CLEAR_AFTER_FIELD(f, fmt.win);
a399810c
HV		 886 if (ops->vidioc_try_fmt_vid_overlay)
887 ret = ops->vidioc_try_fmt_vid_overlay(file,
35ea11ff
HV		 888 fh, f);
889 break;
890 case V4L2_BUF_TYPE_VIDEO_OUTPUT:
7ecc0cf9 891 CLEAR_AFTER_FIELD(f, fmt.pix);
a399810c
HV		 892 if (ops->vidioc_try_fmt_vid_out)
893 ret = ops->vidioc_try_fmt_vid_out(file, fh, f);
35ea11ff
HV		 894 if (!ret)
895 v4l_print_pix_fmt(vfd, &f->fmt.pix);
896 break;
897 case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
7ecc0cf9 898 CLEAR_AFTER_FIELD(f, fmt.win);
a399810c
HV		 899 if (ops->vidioc_try_fmt_vid_out_overlay)
900 ret = ops->vidioc_try_fmt_vid_out_overlay(file,
35ea11ff
HV		 901 fh, f);
902 break;
903 case V4L2_BUF_TYPE_VBI_CAPTURE:
7ecc0cf9 904 CLEAR_AFTER_FIELD(f, fmt.vbi);
a399810c
HV		 905 if (ops->vidioc_try_fmt_vbi_cap)
906 ret = ops->vidioc_try_fmt_vbi_cap(file, fh, f);
35ea11ff
HV		 907 break;
908 case V4L2_BUF_TYPE_VBI_OUTPUT:
7ecc0cf9 909 CLEAR_AFTER_FIELD(f, fmt.vbi);
a399810c
HV		 910 if (ops->vidioc_try_fmt_vbi_out)
911 ret = ops->vidioc_try_fmt_vbi_out(file, fh, f);
35ea11ff
HV		 912 break;
913 case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
7ecc0cf9 914 CLEAR_AFTER_FIELD(f, fmt.sliced);
a399810c
HV		 915 if (ops->vidioc_try_fmt_sliced_vbi_cap)
916 ret = ops->vidioc_try_fmt_sliced_vbi_cap(file,
35ea11ff
HV		 917 fh, f);
918 break;
919 case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
7ecc0cf9 920 CLEAR_AFTER_FIELD(f, fmt.sliced);
a399810c
HV		 921 if (ops->vidioc_try_fmt_sliced_vbi_out)
922 ret = ops->vidioc_try_fmt_sliced_vbi_out(file,
35ea11ff
HV		 923 fh, f);
924 break;
925 case V4L2_BUF_TYPE_PRIVATE:
7ecc0cf9 926 /* CLEAR_AFTER_FIELD(f, fmt.raw_data); <- does nothing */
a399810c
HV		 927 if (ops->vidioc_try_fmt_type_private)
928 ret = ops->vidioc_try_fmt_type_private(file,
35ea11ff
HV		 929 fh, f);
930 break;
931 }
932
933 break;
934 }
935 /* FIXME: Those buf reqs could be handled here,
936 with some changes on videobuf to allow its header to be included at
937 videodev2.h or being merged at videodev2.
938 */
939 case VIDIOC_REQBUFS:
940 {
941 struct v4l2_requestbuffers *p = arg;
942
a399810c 943 if (!ops->vidioc_reqbufs)
35ea11ff 944 break;
a399810c 945 ret = check_fmt(ops, p->type);
35ea11ff
HV		 946 if (ret)
947 break;
948
7ecc0cf9
TP		 949 if (p->type < V4L2_BUF_TYPE_PRIVATE)
950 CLEAR_AFTER_FIELD(p, memory);
951
a399810c 952 ret = ops->vidioc_reqbufs(file, fh, p);
35ea11ff
HV		 953 dbgarg(cmd, "count=%d, type=%s, memory=%s\n",
954 p->count,
955 prt_names(p->type, v4l2_type_names),
956 prt_names(p->memory, v4l2_memory_names));
957 break;
958 }
959 case VIDIOC_QUERYBUF:
960 {
961 struct v4l2_buffer *p = arg;
962
a399810c 963 if (!ops->vidioc_querybuf)
35ea11ff 964 break;
a399810c 965 ret = check_fmt(ops, p->type);
35ea11ff
HV		 966 if (ret)
967 break;
968
a399810c 969 ret = ops->vidioc_querybuf(file, fh, p);
35ea11ff
HV		 970 if (!ret)
971 dbgbuf(cmd, vfd, p);
972 break;
973 }
974 case VIDIOC_QBUF:
975 {
976 struct v4l2_buffer *p = arg;
977
a399810c 978 if (!ops->vidioc_qbuf)
35ea11ff 979 break;
a399810c 980 ret = check_fmt(ops, p->type);
35ea11ff
HV		 981 if (ret)
982 break;
983
a399810c 984 ret = ops->vidioc_qbuf(file, fh, p);
35ea11ff
HV		 985 if (!ret)
986 dbgbuf(cmd, vfd, p);
987 break;
988 }
989 case VIDIOC_DQBUF:
990 {
991 struct v4l2_buffer *p = arg;
992
a399810c 993 if (!ops->vidioc_dqbuf)
35ea11ff 994 break;
a399810c 995 ret = check_fmt(ops, p->type);
35ea11ff
HV		 996 if (ret)
997 break;
998
a399810c 999 ret = ops->vidioc_dqbuf(file, fh, p);
35ea11ff
HV		 1000 if (!ret)
1001 dbgbuf(cmd, vfd, p);
1002 break;
1003 }
1004 case VIDIOC_OVERLAY:
1005 {
1006 int *i = arg;
1007
a399810c 1008 if (!ops->vidioc_overlay)
35ea11ff
HV		 1009 break;
1010 dbgarg(cmd, "value=%d\n", *i);
a399810c 1011 ret = ops->vidioc_overlay(file, fh, *i);
35ea11ff
HV		 1012 break;
1013 }
1014 case VIDIOC_G_FBUF:
1015 {
1016 struct v4l2_framebuffer *p = arg;
1017
a399810c 1018 if (!ops->vidioc_g_fbuf)
35ea11ff 1019 break;
a399810c 1020 ret = ops->vidioc_g_fbuf(file, fh, arg);
35ea11ff
HV		 1021 if (!ret) {
1022 dbgarg(cmd, "capability=0x%x, flags=%d, base=0x%08lx\n",
1023 p->capability, p->flags,
1024 (unsigned long)p->base);
1025 v4l_print_pix_fmt(vfd, &p->fmt);
1026 }
1027 break;
1028 }
1029 case VIDIOC_S_FBUF:
1030 {
1031 struct v4l2_framebuffer *p = arg;
1032
a399810c 1033 if (!ops->vidioc_s_fbuf)
35ea11ff
HV		 1034 break;
1035 dbgarg(cmd, "capability=0x%x, flags=%d, base=0x%08lx\n",
1036 p->capability, p->flags, (unsigned long)p->base);
1037 v4l_print_pix_fmt(vfd, &p->fmt);
a399810c 1038 ret = ops->vidioc_s_fbuf(file, fh, arg);
35ea11ff
HV		 1039 break;
1040 }
1041 case VIDIOC_STREAMON:
1042 {
1043 enum v4l2_buf_type i = *(int *)arg;
1044
a399810c 1045 if (!ops->vidioc_streamon)
35ea11ff
HV		 1046 break;
1047 dbgarg(cmd, "type=%s\n", prt_names(i, v4l2_type_names));
a399810c 1048 ret = ops->vidioc_streamon(file, fh, i);
35ea11ff
HV		 1049 break;
1050 }
1051 case VIDIOC_STREAMOFF:
1052 {
1053 enum v4l2_buf_type i = *(int *)arg;
1054
a399810c 1055 if (!ops->vidioc_streamoff)
35ea11ff
HV		 1056 break;
1057 dbgarg(cmd, "type=%s\n", prt_names(i, v4l2_type_names));
a399810c 1058 ret = ops->vidioc_streamoff(file, fh, i);
35ea11ff
HV		 1059 break;
1060 }
1061 /* ---------- tv norms ---------- */
1062 case VIDIOC_ENUMSTD:
1063 {
1064 struct v4l2_standard *p = arg;
1065 v4l2_std_id id = vfd->tvnorms, curr_id = 0;
1066 unsigned int index = p->index, i, j = 0;
1067 const char *descr = "";
1068
1069 /* Return norm array in a canonical way */
1070 for (i = 0; i <= index && id; i++) {
1071 /* last std value in the standards array is 0, so this
1072 while always ends there since (id & 0) == 0. */
1073 while ((id & standards[j].std) != standards[j].std)
1074 j++;
1075 curr_id = standards[j].std;
1076 descr = standards[j].descr;
1077 j++;
1078 if (curr_id == 0)
1079 break;
1080 if (curr_id != V4L2_STD_PAL &&
1081 curr_id != V4L2_STD_SECAM &&
1082 curr_id != V4L2_STD_NTSC)
1083 id &= ~curr_id;
1084 }
1085 if (i <= index)
3f5e1824 1086 break;
35ea11ff
HV		 1087
1088 v4l2_video_std_construct(p, curr_id, descr);
35ea11ff
HV		 1089
1090 dbgarg(cmd, "index=%d, id=0x%Lx, name=%s, fps=%d/%d, "
1091 "framelines=%d\n", p->index,
1092 (unsigned long long)p->id, p->name,
1093 p->frameperiod.numerator,
1094 p->frameperiod.denominator,
1095 p->framelines);
1096
1097 ret = 0;
1098 break;
1099 }
1100 case VIDIOC_G_STD:
1101 {
1102 v4l2_std_id *id = arg;
1103
1104 ret = 0;
1105 /* Calls the specific handler */
a399810c
HV		 1106 if (ops->vidioc_g_std)
1107 ret = ops->vidioc_g_std(file, fh, id);
9bedc7f7 1108 else if (vfd->current_norm)
35ea11ff 1109 *id = vfd->current_norm;
9bedc7f7
HV		 1110 else
1111 ret = -EINVAL;
35ea11ff
HV		 1112
1113 if (!ret)
1114 dbgarg(cmd, "std=0x%08Lx\n", (long long unsigned)*id);
1115 break;
1116 }
1117 case VIDIOC_S_STD:
1118 {
1119 v4l2_std_id *id = arg, norm;
1120
1121 dbgarg(cmd, "std=%08Lx\n", (long long unsigned)*id);
1122
1123 norm = (*id) & vfd->tvnorms;
1124 if (vfd->tvnorms && !norm) /* Check if std is supported */
1125 break;
1126
1127 /* Calls the specific handler */
a399810c
HV		 1128 if (ops->vidioc_s_std)
1129 ret = ops->vidioc_s_std(file, fh, &norm);
35ea11ff
HV		 1130 else
1131 ret = -EINVAL;
1132
1133 /* Updates standard information */
1134 if (ret >= 0)
1135 vfd->current_norm = norm;
1136 break;
1137 }
1138 case VIDIOC_QUERYSTD:
1139 {
1140 v4l2_std_id *p = arg;
1141
a399810c 1142 if (!ops->vidioc_querystd)
35ea11ff 1143 break;
a399810c 1144 ret = ops->vidioc_querystd(file, fh, arg);
35ea11ff
HV		 1145 if (!ret)
1146 dbgarg(cmd, "detected std=%08Lx\n",
1147 (unsigned long long)*p);
1148 break;
1149 }
1150 /* ------ input switching ---------- */
1151 /* FIXME: Inputs can be handled inside videodev2 */
1152 case VIDIOC_ENUMINPUT:
1153 {
1154 struct v4l2_input *p = arg;
35ea11ff 1155
b6456c0c
MK		 1156 /*
1157 * We set the flags for CAP_PRESETS, CAP_CUSTOM_TIMINGS &
1158 * CAP_STD here based on ioctl handler provided by the
1159 * driver. If the driver doesn't support these
1160 * for a specific input, it must override these flags.
1161 */
1162 if (ops->vidioc_s_std)
1163 p->capabilities |= V4L2_IN_CAP_STD;
1164 if (ops->vidioc_s_dv_preset)
1165 p->capabilities |= V4L2_IN_CAP_PRESETS;
1166 if (ops->vidioc_s_dv_timings)
1167 p->capabilities |= V4L2_IN_CAP_CUSTOM_TIMINGS;
1168
a399810c 1169 if (!ops->vidioc_enum_input)
35ea11ff 1170 break;
35ea11ff 1171
a399810c 1172 ret = ops->vidioc_enum_input(file, fh, p);
35ea11ff
HV		 1173 if (!ret)
1174 dbgarg(cmd, "index=%d, name=%s, type=%d, "
1175 "audioset=%d, "
1176 "tuner=%d, std=%08Lx, status=%d\n",
1177 p->index, p->name, p->type, p->audioset,
1178 p->tuner,
1179 (unsigned long long)p->std,
1180 p->status);
1181 break;
1182 }
1183 case VIDIOC_G_INPUT:
1184 {
1185 unsigned int *i = arg;
1186
a399810c 1187 if (!ops->vidioc_g_input)
35ea11ff 1188 break;
a399810c 1189 ret = ops->vidioc_g_input(file, fh, i);
35ea11ff
HV		 1190 if (!ret)
1191 dbgarg(cmd, "value=%d\n", *i);
1192 break;
1193 }
1194 case VIDIOC_S_INPUT:
1195 {
1196 unsigned int *i = arg;
1197
a399810c 1198 if (!ops->vidioc_s_input)
35ea11ff
HV		 1199 break;
1200 dbgarg(cmd, "value=%d\n", *i);
a399810c 1201 ret = ops->vidioc_s_input(file, fh, *i);
35ea11ff
HV		 1202 break;
1203 }
1204
1205 /* ------ output switching ---------- */
1206 case VIDIOC_ENUMOUTPUT:
1207 {
1208 struct v4l2_output *p = arg;
35ea11ff 1209
a399810c 1210 if (!ops->vidioc_enum_output)
35ea11ff 1211 break;
35ea11ff 1212
b6456c0c
MK		 1213 /*
1214 * We set the flags for CAP_PRESETS, CAP_CUSTOM_TIMINGS &
1215 * CAP_STD here based on ioctl handler provided by the
1216 * driver. If the driver doesn't support these
1217 * for a specific output, it must override these flags.
1218 */
1219 if (ops->vidioc_s_std)
1220 p->capabilities |= V4L2_OUT_CAP_STD;
1221 if (ops->vidioc_s_dv_preset)
1222 p->capabilities |= V4L2_OUT_CAP_PRESETS;
1223 if (ops->vidioc_s_dv_timings)
1224 p->capabilities |= V4L2_OUT_CAP_CUSTOM_TIMINGS;
1225
a399810c 1226 ret = ops->vidioc_enum_output(file, fh, p);
35ea11ff
HV		 1227 if (!ret)
1228 dbgarg(cmd, "index=%d, name=%s, type=%d, "
1229 "audioset=0x%x, "
1230 "modulator=%d, std=0x%08Lx\n",
1231 p->index, p->name, p->type, p->audioset,
1232 p->modulator, (unsigned long long)p->std);
1233 break;
1234 }
1235 case VIDIOC_G_OUTPUT:
1236 {
1237 unsigned int *i = arg;
1238
a399810c 1239 if (!ops->vidioc_g_output)
35ea11ff 1240 break;
a399810c 1241 ret = ops->vidioc_g_output(file, fh, i);
35ea11ff
HV		 1242 if (!ret)
1243 dbgarg(cmd, "value=%d\n", *i);
1244 break;
1245 }
1246 case VIDIOC_S_OUTPUT:
1247 {
1248 unsigned int *i = arg;
1249
a399810c 1250 if (!ops->vidioc_s_output)
35ea11ff
HV		 1251 break;
1252 dbgarg(cmd, "value=%d\n", *i);
a399810c 1253 ret = ops->vidioc_s_output(file, fh, *i);
35ea11ff
HV		 1254 break;
1255 }
1256
1257 /* --- controls ---------------------------------------------- */
1258 case VIDIOC_QUERYCTRL:
1259 {
1260 struct v4l2_queryctrl *p = arg;
1261
a399810c 1262 if (!ops->vidioc_queryctrl)
35ea11ff 1263 break;
a399810c 1264 ret = ops->vidioc_queryctrl(file, fh, p);
35ea11ff
HV		 1265 if (!ret)
1266 dbgarg(cmd, "id=0x%x, type=%d, name=%s, min/max=%d/%d, "
1267 "step=%d, default=%d, flags=0x%08x\n",
1268 p->id, p->type, p->name,
1269 p->minimum, p->maximum,
1270 p->step, p->default_value, p->flags);
1271 else
1272 dbgarg(cmd, "id=0x%x\n", p->id);
1273 break;
1274 }
1275 case VIDIOC_G_CTRL:
1276 {
1277 struct v4l2_control *p = arg;
1278
a399810c
HV		 1279 if (ops->vidioc_g_ctrl)
1280 ret = ops->vidioc_g_ctrl(file, fh, p);
1281 else if (ops->vidioc_g_ext_ctrls) {
35ea11ff
HV		 1282 struct v4l2_ext_controls ctrls;
1283 struct v4l2_ext_control ctrl;
1284
1285 ctrls.ctrl_class = V4L2_CTRL_ID2CLASS(p->id);
1286 ctrls.count = 1;
1287 ctrls.controls = &ctrl;
1288 ctrl.id = p->id;
1289 ctrl.value = p->value;
1290 if (check_ext_ctrls(&ctrls, 1)) {
a399810c 1291 ret = ops->vidioc_g_ext_ctrls(file, fh, &ctrls);
35ea11ff
HV		 1292 if (ret == 0)
1293 p->value = ctrl.value;
1294 }
1295 } else
1296 break;
1297 if (!ret)
1298 dbgarg(cmd, "id=0x%x, value=%d\n", p->id, p->value);
1299 else
1300 dbgarg(cmd, "id=0x%x\n", p->id);
1301 break;
1302 }
1303 case VIDIOC_S_CTRL:
1304 {
1305 struct v4l2_control *p = arg;
1306 struct v4l2_ext_controls ctrls;
1307 struct v4l2_ext_control ctrl;
1308
a399810c 1309 if (!ops->vidioc_s_ctrl && !ops->vidioc_s_ext_ctrls)
35ea11ff
HV		 1310 break;
1311
1312 dbgarg(cmd, "id=0x%x, value=%d\n", p->id, p->value);
1313
a399810c
HV		 1314 if (ops->vidioc_s_ctrl) {
1315 ret = ops->vidioc_s_ctrl(file, fh, p);
35ea11ff
HV		 1316 break;
1317 }
a399810c 1318 if (!ops->vidioc_s_ext_ctrls)
35ea11ff
HV		 1319 break;
1320
1321 ctrls.ctrl_class = V4L2_CTRL_ID2CLASS(p->id);
1322 ctrls.count = 1;
1323 ctrls.controls = &ctrl;
1324 ctrl.id = p->id;
1325 ctrl.value = p->value;
1326 if (check_ext_ctrls(&ctrls, 1))
a399810c 1327 ret = ops->vidioc_s_ext_ctrls(file, fh, &ctrls);
35ea11ff
HV		 1328 break;
1329 }
1330 case VIDIOC_G_EXT_CTRLS:
1331 {
1332 struct v4l2_ext_controls *p = arg;
1333
1334 p->error_idx = p->count;
a399810c 1335 if (!ops->vidioc_g_ext_ctrls)
35ea11ff
HV		 1336 break;
1337 if (check_ext_ctrls(p, 0))
a399810c 1338 ret = ops->vidioc_g_ext_ctrls(file, fh, p);
35ea11ff
HV		 1339 v4l_print_ext_ctrls(cmd, vfd, p, !ret);
1340 break;
1341 }
1342 case VIDIOC_S_EXT_CTRLS:
1343 {
1344 struct v4l2_ext_controls *p = arg;
1345
1346 p->error_idx = p->count;
a399810c 1347 if (!ops->vidioc_s_ext_ctrls)
35ea11ff
HV		 1348 break;
1349 v4l_print_ext_ctrls(cmd, vfd, p, 1);
1350 if (check_ext_ctrls(p, 0))
a399810c 1351 ret = ops->vidioc_s_ext_ctrls(file, fh, p);
35ea11ff
HV		 1352 break;
1353 }
1354 case VIDIOC_TRY_EXT_CTRLS:
1355 {
1356 struct v4l2_ext_controls *p = arg;
1357
1358 p->error_idx = p->count;
a399810c 1359 if (!ops->vidioc_try_ext_ctrls)
35ea11ff
HV		 1360 break;
1361 v4l_print_ext_ctrls(cmd, vfd, p, 1);
1362 if (check_ext_ctrls(p, 0))
a399810c 1363 ret = ops->vidioc_try_ext_ctrls(file, fh, p);
35ea11ff
HV		 1364 break;
1365 }
1366 case VIDIOC_QUERYMENU:
1367 {
1368 struct v4l2_querymenu *p = arg;
1369
a399810c 1370 if (!ops->vidioc_querymenu)
35ea11ff 1371 break;
a399810c 1372 ret = ops->vidioc_querymenu(file, fh, p);
35ea11ff
HV		 1373 if (!ret)
1374 dbgarg(cmd, "id=0x%x, index=%d, name=%s\n",
1375 p->id, p->index, p->name);
1376 else
1377 dbgarg(cmd, "id=0x%x, index=%d\n",
1378 p->id, p->index);
1379 break;
1380 }
1381 /* --- audio ---------------------------------------------- */
1382 case VIDIOC_ENUMAUDIO:
1383 {
1384 struct v4l2_audio *p = arg;
1385
a399810c 1386 if (!ops->vidioc_enumaudio)
35ea11ff 1387 break;
a399810c 1388 ret = ops->vidioc_enumaudio(file, fh, p);
35ea11ff
HV		 1389 if (!ret)
1390 dbgarg(cmd, "index=%d, name=%s, capability=0x%x, "
1391 "mode=0x%x\n", p->index, p->name,
1392 p->capability, p->mode);
1393 else
1394 dbgarg(cmd, "index=%d\n", p->index);
1395 break;
1396 }
1397 case VIDIOC_G_AUDIO:
1398 {
1399 struct v4l2_audio *p = arg;
35ea11ff 1400
a399810c 1401 if (!ops->vidioc_g_audio)
35ea11ff
HV		 1402 break;
1403
a399810c 1404 ret = ops->vidioc_g_audio(file, fh, p);
35ea11ff
HV		 1405 if (!ret)
1406 dbgarg(cmd, "index=%d, name=%s, capability=0x%x, "
1407 "mode=0x%x\n", p->index,
1408 p->name, p->capability, p->mode);
1409 else
1410 dbgarg(cmd, "index=%d\n", p->index);
1411 break;
1412 }
1413 case VIDIOC_S_AUDIO:
1414 {
1415 struct v4l2_audio *p = arg;
1416
a399810c 1417 if (!ops->vidioc_s_audio)
35ea11ff
HV		 1418 break;
1419 dbgarg(cmd, "index=%d, name=%s, capability=0x%x, "
1420 "mode=0x%x\n", p->index, p->name,
1421 p->capability, p->mode);
a399810c 1422 ret = ops->vidioc_s_audio(file, fh, p);
35ea11ff
HV		 1423 break;
1424 }
1425 case VIDIOC_ENUMAUDOUT:
1426 {
1427 struct v4l2_audioout *p = arg;
1428
a399810c 1429 if (!ops->vidioc_enumaudout)
35ea11ff
HV		 1430 break;
1431 dbgarg(cmd, "Enum for index=%d\n", p->index);
a399810c 1432 ret = ops->vidioc_enumaudout(file, fh, p);
35ea11ff
HV		 1433 if (!ret)
1434 dbgarg2("index=%d, name=%s, capability=%d, "
1435 "mode=%d\n", p->index, p->name,
1436 p->capability, p->mode);
1437 break;
1438 }
1439 case VIDIOC_G_AUDOUT:
1440 {
1441 struct v4l2_audioout *p = arg;
1442
a399810c 1443 if (!ops->vidioc_g_audout)
35ea11ff 1444 break;
337f9d20 1445
a399810c 1446 ret = ops->vidioc_g_audout(file, fh, p);
35ea11ff
HV		 1447 if (!ret)
1448 dbgarg2("index=%d, name=%s, capability=%d, "
1449 "mode=%d\n", p->index, p->name,
1450 p->capability, p->mode);
1451 break;
1452 }
1453 case VIDIOC_S_AUDOUT:
1454 {
1455 struct v4l2_audioout *p = arg;
1456
a399810c 1457 if (!ops->vidioc_s_audout)
35ea11ff
HV		 1458 break;
1459 dbgarg(cmd, "index=%d, name=%s, capability=%d, "
1460 "mode=%d\n", p->index, p->name,
1461 p->capability, p->mode);
1462
a399810c 1463 ret = ops->vidioc_s_audout(file, fh, p);
35ea11ff
HV		 1464 break;
1465 }
1466 case VIDIOC_G_MODULATOR:
1467 {
1468 struct v4l2_modulator *p = arg;
1469
a399810c 1470 if (!ops->vidioc_g_modulator)
35ea11ff 1471 break;
a399810c 1472 ret = ops->vidioc_g_modulator(file, fh, p);
35ea11ff
HV		 1473 if (!ret)
1474 dbgarg(cmd, "index=%d, name=%s, "
1475 "capability=%d, rangelow=%d,"
1476 " rangehigh=%d, txsubchans=%d\n",
1477 p->index, p->name, p->capability,
1478 p->rangelow, p->rangehigh,
1479 p->txsubchans);
1480 break;
1481 }
1482 case VIDIOC_S_MODULATOR:
1483 {
1484 struct v4l2_modulator *p = arg;
1485
a399810c 1486 if (!ops->vidioc_s_modulator)
35ea11ff
HV		 1487 break;
1488 dbgarg(cmd, "index=%d, name=%s, capability=%d, "
1489 "rangelow=%d, rangehigh=%d, txsubchans=%d\n",
1490 p->index, p->name, p->capability, p->rangelow,
1491 p->rangehigh, p->txsubchans);
a399810c 1492 ret = ops->vidioc_s_modulator(file, fh, p);
35ea11ff
HV		 1493 break;
1494 }
1495 case VIDIOC_G_CROP:
1496 {
1497 struct v4l2_crop *p = arg;
1498
a399810c 1499 if (!ops->vidioc_g_crop)
35ea11ff 1500 break;
a56a18c3 1501
35ea11ff 1502 dbgarg(cmd, "type=%s\n", prt_names(p->type, v4l2_type_names));
a399810c 1503 ret = ops->vidioc_g_crop(file, fh, p);
35ea11ff
HV		 1504 if (!ret)
1505 dbgrect(vfd, "", &p->c);
1506 break;
1507 }
1508 case VIDIOC_S_CROP:
1509 {
1510 struct v4l2_crop *p = arg;
1511
a399810c 1512 if (!ops->vidioc_s_crop)
35ea11ff
HV		 1513 break;
1514 dbgarg(cmd, "type=%s\n", prt_names(p->type, v4l2_type_names));
1515 dbgrect(vfd, "", &p->c);
a399810c 1516 ret = ops->vidioc_s_crop(file, fh, p);
35ea11ff
HV		 1517 break;
1518 }
1519 case VIDIOC_CROPCAP:
1520 {
1521 struct v4l2_cropcap *p = arg;
1522
1523 /*FIXME: Should also show v4l2_fract pixelaspect */
a399810c 1524 if (!ops->vidioc_cropcap)
35ea11ff 1525 break;
a56a18c3 1526
35ea11ff 1527 dbgarg(cmd, "type=%s\n", prt_names(p->type, v4l2_type_names));
a399810c 1528 ret = ops->vidioc_cropcap(file, fh, p);
35ea11ff
HV		 1529 if (!ret) {
1530 dbgrect(vfd, "bounds ", &p->bounds);
1531 dbgrect(vfd, "defrect ", &p->defrect);
1532 }
1533 break;
1534 }
1535 case VIDIOC_G_JPEGCOMP:
1536 {
1537 struct v4l2_jpegcompression *p = arg;
1538
a399810c 1539 if (!ops->vidioc_g_jpegcomp)
35ea11ff 1540 break;
a56a18c3 1541
a399810c 1542 ret = ops->vidioc_g_jpegcomp(file, fh, p);
35ea11ff
HV		 1543 if (!ret)
1544 dbgarg(cmd, "quality=%d, APPn=%d, "
1545 "APP_len=%d, COM_len=%d, "
1546 "jpeg_markers=%d\n",
1547 p->quality, p->APPn, p->APP_len,
1548 p->COM_len, p->jpeg_markers);
1549 break;
1550 }
1551 case VIDIOC_S_JPEGCOMP:
1552 {
1553 struct v4l2_jpegcompression *p = arg;
1554
a399810c 1555 if (!ops->vidioc_g_jpegcomp)
35ea11ff
HV		 1556 break;
1557 dbgarg(cmd, "quality=%d, APPn=%d, APP_len=%d, "
1558 "COM_len=%d, jpeg_markers=%d\n",
1559 p->quality, p->APPn, p->APP_len,
1560 p->COM_len, p->jpeg_markers);
a399810c 1561 ret = ops->vidioc_s_jpegcomp(file, fh, p);
35ea11ff
HV		 1562 break;
1563 }
1564 case VIDIOC_G_ENC_INDEX:
1565 {
1566 struct v4l2_enc_idx *p = arg;
1567
a399810c 1568 if (!ops->vidioc_g_enc_index)
35ea11ff 1569 break;
a399810c 1570 ret = ops->vidioc_g_enc_index(file, fh, p);
35ea11ff
HV		 1571 if (!ret)
1572 dbgarg(cmd, "entries=%d, entries_cap=%d\n",
1573 p->entries, p->entries_cap);
1574 break;
1575 }
1576 case VIDIOC_ENCODER_CMD:
1577 {
1578 struct v4l2_encoder_cmd *p = arg;
1579
a399810c 1580 if (!ops->vidioc_encoder_cmd)
35ea11ff 1581 break;
a399810c 1582 ret = ops->vidioc_encoder_cmd(file, fh, p);
35ea11ff
HV		 1583 if (!ret)
1584 dbgarg(cmd, "cmd=%d, flags=%x\n", p->cmd, p->flags);
1585 break;
1586 }
1587 case VIDIOC_TRY_ENCODER_CMD:
1588 {
1589 struct v4l2_encoder_cmd *p = arg;
1590
a399810c 1591 if (!ops->vidioc_try_encoder_cmd)
35ea11ff 1592 break;
a399810c 1593 ret = ops->vidioc_try_encoder_cmd(file, fh, p);
35ea11ff
HV		 1594 if (!ret)
1595 dbgarg(cmd, "cmd=%d, flags=%x\n", p->cmd, p->flags);
1596 break;
1597 }
1598 case VIDIOC_G_PARM:
1599 {
1600 struct v4l2_streamparm *p = arg;
35ea11ff 1601
a399810c 1602 if (ops->vidioc_g_parm) {
34796bc0
TP		 1603 ret = check_fmt(ops, p->type);
1604 if (ret)
1605 break;
a399810c 1606 ret = ops->vidioc_g_parm(file, fh, p);
35ea11ff 1607 } else {
9bedc7f7
HV		 1608 v4l2_std_id std = vfd->current_norm;
1609
35ea11ff 1610 if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
3f5e1824 1611 break;
35ea11ff 1612
35ea11ff 1613 ret = 0;
9bedc7f7
HV		 1614 if (ops->vidioc_g_std)
1615 ret = ops->vidioc_g_std(file, fh, &std);
1616 else if (std == 0)
1617 ret = -EINVAL;
1618 if (ret == 0)
1619 v4l2_video_std_frame_period(std,
1620 &p->parm.capture.timeperframe);
35ea11ff
HV		 1621 }
1622
1623 dbgarg(cmd, "type=%d\n", p->type);
1624 break;
1625 }
1626 case VIDIOC_S_PARM:
1627 {
1628 struct v4l2_streamparm *p = arg;
1629
a399810c 1630 if (!ops->vidioc_s_parm)
35ea11ff 1631 break;
34796bc0
TP		 1632 ret = check_fmt(ops, p->type);
1633 if (ret)
1634 break;
1635
35ea11ff 1636 dbgarg(cmd, "type=%d\n", p->type);
a399810c 1637 ret = ops->vidioc_s_parm(file, fh, p);
35ea11ff
HV		 1638 break;
1639 }
1640 case VIDIOC_G_TUNER:
1641 {
1642 struct v4l2_tuner *p = arg;
35ea11ff 1643
a399810c 1644 if (!ops->vidioc_g_tuner)
35ea11ff
HV		 1645 break;
1646
a399810c 1647 ret = ops->vidioc_g_tuner(file, fh, p);
35ea11ff
HV		 1648 if (!ret)
1649 dbgarg(cmd, "index=%d, name=%s, type=%d, "
1650 "capability=0x%x, rangelow=%d, "
1651 "rangehigh=%d, signal=%d, afc=%d, "
1652 "rxsubchans=0x%x, audmode=%d\n",
1653 p->index, p->name, p->type,
1654 p->capability, p->rangelow,
1655 p->rangehigh, p->signal, p->afc,
1656 p->rxsubchans, p->audmode);
1657 break;
1658 }
1659 case VIDIOC_S_TUNER:
1660 {
1661 struct v4l2_tuner *p = arg;
1662
a399810c 1663 if (!ops->vidioc_s_tuner)
35ea11ff
HV		 1664 break;
1665 dbgarg(cmd, "index=%d, name=%s, type=%d, "
1666 "capability=0x%x, rangelow=%d, "
1667 "rangehigh=%d, signal=%d, afc=%d, "
1668 "rxsubchans=0x%x, audmode=%d\n",
1669 p->index, p->name, p->type,
1670 p->capability, p->rangelow,
1671 p->rangehigh, p->signal, p->afc,
1672 p->rxsubchans, p->audmode);
a399810c 1673 ret = ops->vidioc_s_tuner(file, fh, p);
35ea11ff
HV		 1674 break;
1675 }
1676 case VIDIOC_G_FREQUENCY:
1677 {
1678 struct v4l2_frequency *p = arg;
1679
a399810c 1680 if (!ops->vidioc_g_frequency)
35ea11ff
HV		 1681 break;
1682
a399810c 1683 ret = ops->vidioc_g_frequency(file, fh, p);
35ea11ff
HV		 1684 if (!ret)
1685 dbgarg(cmd, "tuner=%d, type=%d, frequency=%d\n",
1686 p->tuner, p->type, p->frequency);
1687 break;
1688 }
1689 case VIDIOC_S_FREQUENCY:
1690 {
1691 struct v4l2_frequency *p = arg;
1692
a399810c 1693 if (!ops->vidioc_s_frequency)
35ea11ff
HV		 1694 break;
1695 dbgarg(cmd, "tuner=%d, type=%d, frequency=%d\n",
1696 p->tuner, p->type, p->frequency);
a399810c 1697 ret = ops->vidioc_s_frequency(file, fh, p);
35ea11ff
HV		 1698 break;
1699 }
1700 case VIDIOC_G_SLICED_VBI_CAP:
1701 {
1702 struct v4l2_sliced_vbi_cap *p = arg;
35ea11ff 1703
a399810c 1704 if (!ops->vidioc_g_sliced_vbi_cap)
35ea11ff 1705 break;
19c96e4b
TP		 1706
1707 /* Clear up to type, everything after type is zerod already */
1708 memset(p, 0, offsetof(struct v4l2_sliced_vbi_cap, type));
1709
35ea11ff 1710 dbgarg(cmd, "type=%s\n", prt_names(p->type, v4l2_type_names));
a399810c 1711 ret = ops->vidioc_g_sliced_vbi_cap(file, fh, p);
35ea11ff
HV		 1712 if (!ret)
1713 dbgarg2("service_set=%d\n", p->service_set);
1714 break;
1715 }
1716 case VIDIOC_LOG_STATUS:
1717 {
a399810c 1718 if (!ops->vidioc_log_status)
35ea11ff 1719 break;
a399810c 1720 ret = ops->vidioc_log_status(file, fh);
35ea11ff
HV		 1721 break;
1722 }
1723#ifdef CONFIG_VIDEO_ADV_DEBUG
1724 case VIDIOC_DBG_G_REGISTER:
1725 {
aecde8b5 1726 struct v4l2_dbg_register *p = arg;
35ea11ff
HV		 1727
1728 if (!capable(CAP_SYS_ADMIN))
1729 ret = -EPERM;
a399810c
HV		 1730 else if (ops->vidioc_g_register)
1731 ret = ops->vidioc_g_register(file, fh, p);
35ea11ff
HV		 1732 break;
1733 }
1734 case VIDIOC_DBG_S_REGISTER:
1735 {
aecde8b5 1736 struct v4l2_dbg_register *p = arg;
35ea11ff
HV		 1737
1738 if (!capable(CAP_SYS_ADMIN))
1739 ret = -EPERM;
a399810c
HV		 1740 else if (ops->vidioc_s_register)
1741 ret = ops->vidioc_s_register(file, fh, p);
35ea11ff
HV		 1742 break;
1743 }
1744#endif
aecde8b5 1745 case VIDIOC_DBG_G_CHIP_IDENT:
35ea11ff 1746 {
aecde8b5 1747 struct v4l2_dbg_chip_ident *p = arg;
35ea11ff 1748
a399810c 1749 if (!ops->vidioc_g_chip_ident)
35ea11ff 1750 break;
80b36e0f
HV		 1751 p->ident = V4L2_IDENT_NONE;
1752 p->revision = 0;
a399810c 1753 ret = ops->vidioc_g_chip_ident(file, fh, p);
35ea11ff
HV		 1754 if (!ret)
1755 dbgarg(cmd, "chip_ident=%u, revision=0x%x\n", p->ident, p->revision);
1756 break;
1757 }
35ea11ff
HV		 1758 case VIDIOC_S_HW_FREQ_SEEK:
1759 {
1760 struct v4l2_hw_freq_seek *p = arg;
1761
a399810c 1762 if (!ops->vidioc_s_hw_freq_seek)
35ea11ff
HV		 1763 break;
1764 dbgarg(cmd,
1765 "tuner=%d, type=%d, seek_upward=%d, wrap_around=%d\n",
1766 p->tuner, p->type, p->seek_upward, p->wrap_around);
a399810c
HV		 1767 ret = ops->vidioc_s_hw_freq_seek(file, fh, p);
1768 break;
1769 }
74d83fa0
MCC		 1770 case VIDIOC_ENUM_FRAMESIZES:
1771 {
1772 struct v4l2_frmsizeenum *p = arg;
1773
1774 if (!ops->vidioc_enum_framesizes)
1775 break;
1776
74d83fa0
MCC		 1777 ret = ops->vidioc_enum_framesizes(file, fh, p);
1778 dbgarg(cmd,
d1afe425
MCC		 1779 "index=%d, pixelformat=%c%c%c%c, type=%d ",
1780 p->index,
1781 (p->pixel_format & 0xff),
1782 (p->pixel_format >> 8) & 0xff,
1783 (p->pixel_format >> 16) & 0xff,
1784 (p->pixel_format >> 24) & 0xff,
1785 p->type);
74d83fa0
MCC		 1786 switch (p->type) {
1787 case V4L2_FRMSIZE_TYPE_DISCRETE:
d33fbcbb 1788 dbgarg3("width = %d, height=%d\n",
74d83fa0
MCC		 1789 p->discrete.width, p->discrete.height);
1790 break;
1791 case V4L2_FRMSIZE_TYPE_STEPWISE:
d33fbcbb 1792 dbgarg3("min %dx%d, max %dx%d, step %dx%d\n",
74d83fa0
MCC		 1793 p->stepwise.min_width, p->stepwise.min_height,
1794 p->stepwise.step_width, p->stepwise.step_height,
1795 p->stepwise.max_width, p->stepwise.max_height);
1796 break;
1797 case V4L2_FRMSIZE_TYPE_CONTINUOUS:
d33fbcbb 1798 dbgarg3("continuous\n");
74d83fa0
MCC		 1799 break;
1800 default:
d33fbcbb 1801 dbgarg3("- Unknown type!\n");
74d83fa0
MCC		 1802 }
1803
1804 break;
1805 }
1806 case VIDIOC_ENUM_FRAMEINTERVALS:
1807 {
1808 struct v4l2_frmivalenum *p = arg;
1809
1810 if (!ops->vidioc_enum_frameintervals)
1811 break;
1812
74d83fa0
MCC		 1813 ret = ops->vidioc_enum_frameintervals(file, fh, p);
1814 dbgarg(cmd,
1815 "index=%d, pixelformat=%d, width=%d, height=%d, type=%d ",
1816 p->index, p->pixel_format,
1817 p->width, p->height, p->type);
1818 switch (p->type) {
1819 case V4L2_FRMIVAL_TYPE_DISCRETE:
1820 dbgarg2("fps=%d/%d\n",
1821 p->discrete.numerator,
1822 p->discrete.denominator);
1823 break;
1824 case V4L2_FRMIVAL_TYPE_STEPWISE:
1958578d
MCC		 1825 dbgarg2("min=%d/%d, max=%d/%d, step=%d/%d\n",
1826 p->stepwise.min.numerator,
1827 p->stepwise.min.denominator,
1828 p->stepwise.max.numerator,
1829 p->stepwise.max.denominator,
1830 p->stepwise.step.numerator,
1831 p->stepwise.step.denominator);
74d83fa0
MCC		 1832 break;
1833 case V4L2_FRMIVAL_TYPE_CONTINUOUS:
1834 dbgarg2("continuous\n");
1835 break;
1836 default:
1837 dbgarg2("- Unknown type!\n");
1838 }
1839 break;
1840 }
b6456c0c
MK		 1841 case VIDIOC_ENUM_DV_PRESETS:
1842 {
1843 struct v4l2_dv_enum_preset *p = arg;
1844
1845 if (!ops->vidioc_enum_dv_presets)
1846 break;
1847
1848 ret = ops->vidioc_enum_dv_presets(file, fh, p);
1849 if (!ret)
1850 dbgarg(cmd,
1851 "index=%d, preset=%d, name=%s, width=%d,"
1852 " height=%d ",
1853 p->index, p->preset, p->name, p->width,
1854 p->height);
1855 break;
1856 }
1857 case VIDIOC_S_DV_PRESET:
1858 {
1859 struct v4l2_dv_preset *p = arg;
1860
1861 if (!ops->vidioc_s_dv_preset)
1862 break;
1863
1864 dbgarg(cmd, "preset=%d\n", p->preset);
1865 ret = ops->vidioc_s_dv_preset(file, fh, p);
1866 break;
1867 }
1868 case VIDIOC_G_DV_PRESET:
1869 {
1870 struct v4l2_dv_preset *p = arg;
1871
1872 if (!ops->vidioc_g_dv_preset)
1873 break;
1874
1875 ret = ops->vidioc_g_dv_preset(file, fh, p);
1876 if (!ret)
1877 dbgarg(cmd, "preset=%d\n", p->preset);
1878 break;
1879 }
1880 case VIDIOC_QUERY_DV_PRESET:
1881 {
1882 struct v4l2_dv_preset *p = arg;
1883
1884 if (!ops->vidioc_query_dv_preset)
1885 break;
1886
1887 ret = ops->vidioc_query_dv_preset(file, fh, p);
1888 if (!ret)
1889 dbgarg(cmd, "preset=%d\n", p->preset);
1890 break;
1891 }
1892 case VIDIOC_S_DV_TIMINGS:
1893 {
1894 struct v4l2_dv_timings *p = arg;
1895
1896 if (!ops->vidioc_s_dv_timings)
1897 break;
1898
1899 switch (p->type) {
1900 case V4L2_DV_BT_656_1120:
1901 dbgarg2("bt-656/1120:interlaced=%d, pixelclock=%lld,"
1902 " width=%d, height=%d, polarities=%x,"
1903 " hfrontporch=%d, hsync=%d, hbackporch=%d,"
1904 " vfrontporch=%d, vsync=%d, vbackporch=%d,"
1905 " il_vfrontporch=%d, il_vsync=%d,"
1906 " il_vbackporch=%d\n",
1907 p->bt.interlaced, p->bt.pixelclock,
1908 p->bt.width, p->bt.height, p->bt.polarities,
1909 p->bt.hfrontporch, p->bt.hsync,
1910 p->bt.hbackporch, p->bt.vfrontporch,
1911 p->bt.vsync, p->bt.vbackporch,
1912 p->bt.il_vfrontporch, p->bt.il_vsync,
1913 p->bt.il_vbackporch);
1914 ret = ops->vidioc_s_dv_timings(file, fh, p);
1915 break;
1916 default:
1917 dbgarg2("Unknown type %d!\n", p->type);
1918 break;
1919 }
1920 break;
1921 }
1922 case VIDIOC_G_DV_TIMINGS:
1923 {
1924 struct v4l2_dv_timings *p = arg;
1925
1926 if (!ops->vidioc_g_dv_timings)
1927 break;
1928
1929 ret = ops->vidioc_g_dv_timings(file, fh, p);
1930 if (!ret) {
1931 switch (p->type) {
1932 case V4L2_DV_BT_656_1120:
1933 dbgarg2("bt-656/1120:interlaced=%d,"
1934 " pixelclock=%lld,"
1935 " width=%d, height=%d, polarities=%x,"
1936 " hfrontporch=%d, hsync=%d,"
1937 " hbackporch=%d, vfrontporch=%d,"
1938 " vsync=%d, vbackporch=%d,"
1939 " il_vfrontporch=%d, il_vsync=%d,"
1940 " il_vbackporch=%d\n",
1941 p->bt.interlaced, p->bt.pixelclock,
1942 p->bt.width, p->bt.height,
1943 p->bt.polarities, p->bt.hfrontporch,
1944 p->bt.hsync, p->bt.hbackporch,
1945 p->bt.vfrontporch, p->bt.vsync,
1946 p->bt.vbackporch, p->bt.il_vfrontporch,
1947 p->bt.il_vsync, p->bt.il_vbackporch);
1948 break;
1949 default:
1950 dbgarg2("Unknown type %d!\n", p->type);
1951 break;
1952 }
1953 }
1954 break;
1955 }
d3d7c963
SA		 1956 case VIDIOC_DQEVENT:
1957 {
1958 struct v4l2_event *ev = arg;
1959
1960 if (!ops->vidioc_subscribe_event)
1961 break;
1962
1963 ret = v4l2_event_dequeue(fh, ev, file->f_flags & O_NONBLOCK);
1964 if (ret < 0) {
1965 dbgarg(cmd, "no pending events?");
1966 break;
1967 }
1968 dbgarg(cmd,
1969 "pending=%d, type=0x%8.8x, sequence=%d, "
1970 "timestamp=%lu.%9.9lu ",
1971 ev->pending, ev->type, ev->sequence,
1972 ev->timestamp.tv_sec, ev->timestamp.tv_nsec);
1973 break;
1974 }
1975 case VIDIOC_SUBSCRIBE_EVENT:
1976 {
1977 struct v4l2_event_subscription *sub = arg;
1978
1979 if (!ops->vidioc_subscribe_event)
1980 break;
74d83fa0 1981
d3d7c963
SA		 1982 ret = ops->vidioc_subscribe_event(fh, sub);
1983 if (ret < 0) {
1984 dbgarg(cmd, "failed, ret=%ld", ret);
1985 break;
1986 }
1987 dbgarg(cmd, "type=0x%8.8x", sub->type);
1988 break;
1989 }
1990 case VIDIOC_UNSUBSCRIBE_EVENT:
1991 {
1992 struct v4l2_event_subscription *sub = arg;
1993
1994 if (!ops->vidioc_unsubscribe_event)
1995 break;
1996
1997 ret = ops->vidioc_unsubscribe_event(fh, sub);
1998 if (ret < 0) {
1999 dbgarg(cmd, "failed, ret=%ld", ret);
2000 break;
2001 }
2002 dbgarg(cmd, "type=0x%8.8x", sub->type);
2003 break;
2004 }
a399810c
HV		 2005 default:
2006 {
2007 if (!ops->vidioc_default)
2008 break;
2009 ret = ops->vidioc_default(file, fh, cmd, arg);
35ea11ff
HV		 2010 break;
2011 }
2012 } /* switch */
2013
2014 if (vfd->debug & V4L2_DEBUG_IOCTL_ARG) {
2015 if (ret < 0) {
2016 v4l_print_ioctl(vfd->name, cmd);
069b7479 2017 printk(KERN_CONT " error %ld\n", ret);
35ea11ff
HV		 2018 }
2019 }
2020
2021 return ret;
2022}
2023
19c96e4b
TP		 2024/* In some cases, only a few fields are used as input, i.e. when the app sets
2025 * "index" and then the driver fills in the rest of the structure for the thing
2026 * with that index. We only need to copy up the first non-input field. */
2027static unsigned long cmd_input_size(unsigned int cmd)
2028{
2029 /* Size of structure up to and including 'field' */
9f1a693f
HV		 2030#define CMDINSIZE(cmd, type, field) \
2031 case VIDIOC_##cmd: \
2032 return offsetof(struct v4l2_##type, field) + \
2033 sizeof(((struct v4l2_##type *)0)->field);
19c96e4b 2034
9f1a693f 2035 switch (cmd) {
19c96e4b
TP		 2036 CMDINSIZE(ENUM_FMT, fmtdesc, type);
2037 CMDINSIZE(G_FMT, format, type);
2038 CMDINSIZE(QUERYBUF, buffer, type);
2039 CMDINSIZE(G_PARM, streamparm, type);
2040 CMDINSIZE(ENUMSTD, standard, index);
2041 CMDINSIZE(ENUMINPUT, input, index);
2042 CMDINSIZE(G_CTRL, control, id);
2043 CMDINSIZE(G_TUNER, tuner, index);
2044 CMDINSIZE(QUERYCTRL, queryctrl, id);
2045 CMDINSIZE(QUERYMENU, querymenu, index);
2046 CMDINSIZE(ENUMOUTPUT, output, index);
2047 CMDINSIZE(G_MODULATOR, modulator, index);
2048 CMDINSIZE(G_FREQUENCY, frequency, tuner);
2049 CMDINSIZE(CROPCAP, cropcap, type);
2050 CMDINSIZE(G_CROP, crop, type);
2051 CMDINSIZE(ENUMAUDIO, audio, index);
2052 CMDINSIZE(ENUMAUDOUT, audioout, index);
2053 CMDINSIZE(ENCODER_CMD, encoder_cmd, flags);
2054 CMDINSIZE(TRY_ENCODER_CMD, encoder_cmd, flags);
2055 CMDINSIZE(G_SLICED_VBI_CAP, sliced_vbi_cap, type);
2056 CMDINSIZE(ENUM_FRAMESIZES, frmsizeenum, pixel_format);
2057 CMDINSIZE(ENUM_FRAMEINTERVALS, frmivalenum, height);
2058 default:
2059 return _IOC_SIZE(cmd);
2060 }
2061}
2062
069b7479 2063long video_ioctl2(struct file *file,
35ea11ff
HV		 2064 unsigned int cmd, unsigned long arg)
2065{
2066 char sbuf[128];
2067 void *mbuf = NULL;
1d94aa36 2068 void *parg = (void *)arg;
069b7479 2069 long err = -EINVAL;
35ea11ff
HV		 2070 int is_ext_ctrl;
2071 size_t ctrls_size = 0;
2072 void __user *user_ptr = NULL;
2073
2074#ifdef __OLD_VIDIOC_
2075 cmd = video_fix_command(cmd);
2076#endif
2077 is_ext_ctrl = (cmd == VIDIOC_S_EXT_CTRLS || cmd == VIDIOC_G_EXT_CTRLS ||
2078 cmd == VIDIOC_TRY_EXT_CTRLS);
2079
2080 /* Copy arguments into temp kernel buffer */
337f9d20 2081 if (_IOC_DIR(cmd) != _IOC_NONE) {
35ea11ff
HV		 2082 if (_IOC_SIZE(cmd) <= sizeof(sbuf)) {
2083 parg = sbuf;
2084 } else {
2085 /* too big to allocate from stack */
2086 mbuf = kmalloc(_IOC_SIZE(cmd), GFP_KERNEL);
2087 if (NULL == mbuf)
2088 return -ENOMEM;
2089 parg = mbuf;
2090 }
2091
2092 err = -EFAULT;
19c96e4b
TP		 2093 if (_IOC_DIR(cmd) & _IOC_WRITE) {
2094 unsigned long n = cmd_input_size(cmd);
2095
2096 if (copy_from_user(parg, (void __user *)arg, n))
35ea11ff 2097 goto out;
19c96e4b
TP		 2098
2099 /* zero out anything we don't copy from userspace */
2100 if (n < _IOC_SIZE(cmd))
2101 memset((u8 *)parg + n, 0, _IOC_SIZE(cmd) - n);
337f9d20
TP		 2102 } else {
2103 /* read-only ioctl */
2104 memset(parg, 0, _IOC_SIZE(cmd));
19c96e4b 2105 }
35ea11ff
HV		 2106 }
2107
2108 if (is_ext_ctrl) {
2109 struct v4l2_ext_controls *p = parg;
2110
2111 /* In case of an error, tell the caller that it wasn't
2112 a specific control that caused it. */
2113 p->error_idx = p->count;
2114 user_ptr = (void __user *)p->controls;
2115 if (p->count) {
2116 ctrls_size = sizeof(struct v4l2_ext_control) * p->count;
2117 /* Note: v4l2_ext_controls fits in sbuf[] so mbuf is still NULL. */
2118 mbuf = kmalloc(ctrls_size, GFP_KERNEL);
2119 err = -ENOMEM;
2120 if (NULL == mbuf)
2121 goto out_ext_ctrl;
2122 err = -EFAULT;
2123 if (copy_from_user(mbuf, user_ptr, ctrls_size))
2124 goto out_ext_ctrl;
2125 p->controls = mbuf;
2126 }
2127 }
2128
2129 /* Handles IOCTL */
b1f88407 2130 err = __video_do_ioctl(file, cmd, parg);
35ea11ff
HV		 2131 if (err == -ENOIOCTLCMD)
2132 err = -EINVAL;
2133 if (is_ext_ctrl) {
2134 struct v4l2_ext_controls *p = parg;
2135
2136 p->controls = (void *)user_ptr;
2137 if (p->count && err == 0 && copy_to_user(user_ptr, mbuf, ctrls_size))
2138 err = -EFAULT;
2139 goto out_ext_ctrl;
2140 }
2141 if (err < 0)
2142 goto out;
2143
2144out_ext_ctrl:
2145 /* Copy results into user buffer */
2146 switch (_IOC_DIR(cmd)) {
2147 case _IOC_READ:
2148 case (_IOC_WRITE | _IOC_READ):
2149 if (copy_to_user((void __user *)arg, parg, _IOC_SIZE(cmd)))
2150 err = -EFAULT;
2151 break;
2152 }
2153
2154out:
2155 kfree(mbuf);
2156 return err;
2157}
8a522c91 2158EXPORT_SYMBOL(video_ioctl2);
Linux 6.x block layer and io_uring tree(s)