1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
16
17#include <linux/module.h>
18#include <linux/types.h>
19#include <linux/kernel.h>
20#include <linux/mm.h>
21#include <linux/string.h>
22#include <linux/errno.h>
23#include <linux/init.h>
24#include <linux/kmod.h>
25#include <linux/slab.h>
26#include <linux/uaccess.h>
27
28#include <media/v4l2-common.h>
29#include <media/v4l2-device.h>
30#include <media/v4l2-ioctl.h>
31
32#define VIDEO_NUM_DEVICES 256
33#define VIDEO_NAME "video4linux"
34
35#define dprintk(fmt, arg...) do { \
36 printk(KERN_DEBUG pr_fmt("%s: " fmt), \
37 __func__, ##arg); \
38} while (0)
39
40
41
42
43
44
45static ssize_t index_show(struct device *cd,
46 struct device_attribute *attr, char *buf)
47{
48 struct video_device *vdev = to_video_device(cd);
49
50 return sprintf(buf, "%i\n", vdev->index);
51}
52static DEVICE_ATTR_RO(index);
53
54static ssize_t dev_debug_show(struct device *cd,
55 struct device_attribute *attr, char *buf)
56{
57 struct video_device *vdev = to_video_device(cd);
58
59 return sprintf(buf, "%i\n", vdev->dev_debug);
60}
61
62static ssize_t dev_debug_store(struct device *cd, struct device_attribute *attr,
63 const char *buf, size_t len)
64{
65 struct video_device *vdev = to_video_device(cd);
66 int res = 0;
67 u16 value;
68
69 res = kstrtou16(buf, 0, &value);
70 if (res)
71 return res;
72
73 vdev->dev_debug = value;
74 return len;
75}
76static DEVICE_ATTR_RW(dev_debug);
77
78static ssize_t name_show(struct device *cd,
79 struct device_attribute *attr, char *buf)
80{
81 struct video_device *vdev = to_video_device(cd);
82
83 return sprintf(buf, "%.*s\n", (int)sizeof(vdev->name), vdev->name);
84}
85static DEVICE_ATTR_RO(name);
86
87static struct attribute *video_device_attrs[] = {
88 &dev_attr_name.attr,
89 &dev_attr_dev_debug.attr,
90 &dev_attr_index.attr,
91 NULL,
92};
93ATTRIBUTE_GROUPS(video_device);
94
95
96
97
98static struct video_device *video_devices[VIDEO_NUM_DEVICES];
99static DEFINE_MUTEX(videodev_lock);
100static DECLARE_BITMAP(devnode_nums[VFL_TYPE_MAX], VIDEO_NUM_DEVICES);
101
102
103
104
105
106
107#ifdef CONFIG_VIDEO_FIXED_MINOR_RANGES
108
109static inline unsigned long *devnode_bits(enum vfl_devnode_type vfl_type)
110{
111
112
113
114 int idx = (vfl_type > VFL_TYPE_RADIO) ? VFL_TYPE_MAX - 1 : vfl_type;
115
116 return devnode_nums[idx];
117}
118#else
119
120static inline unsigned long *devnode_bits(enum vfl_devnode_type vfl_type)
121{
122 return devnode_nums[vfl_type];
123}
124#endif
125
126
127static inline void devnode_set(struct video_device *vdev)
128{
129 set_bit(vdev->num, devnode_bits(vdev->vfl_type));
130}
131
132
133static inline void devnode_clear(struct video_device *vdev)
134{
135 clear_bit(vdev->num, devnode_bits(vdev->vfl_type));
136}
137
138
139static inline int devnode_find(struct video_device *vdev, int from, int to)
140{
141 return find_next_zero_bit(devnode_bits(vdev->vfl_type), to, from);
142}
143
144struct video_device *video_device_alloc(void)
145{
146 return kzalloc(sizeof(struct video_device), GFP_KERNEL);
147}
148EXPORT_SYMBOL(video_device_alloc);
149
150void video_device_release(struct video_device *vdev)
151{
152 kfree(vdev);
153}
154EXPORT_SYMBOL(video_device_release);
155
156void video_device_release_empty(struct video_device *vdev)
157{
158
159
160}
161EXPORT_SYMBOL(video_device_release_empty);
162
163static inline void video_get(struct video_device *vdev)
164{
165 get_device(&vdev->dev);
166}
167
168static inline void video_put(struct video_device *vdev)
169{
170 put_device(&vdev->dev);
171}
172
173
174static void v4l2_device_release(struct device *cd)
175{
176 struct video_device *vdev = to_video_device(cd);
177 struct v4l2_device *v4l2_dev = vdev->v4l2_dev;
178
179 mutex_lock(&videodev_lock);
180 if (WARN_ON(video_devices[vdev->minor] != vdev)) {
181
182 mutex_unlock(&videodev_lock);
183 return;
184 }
185
186
187 video_devices[vdev->minor] = NULL;
188
189
190 cdev_del(vdev->cdev);
191
192
193 vdev->cdev = NULL;
194
195
196 devnode_clear(vdev);
197
198 mutex_unlock(&videodev_lock);
199
200#if defined(CONFIG_MEDIA_CONTROLLER)
201 if (v4l2_dev->mdev && vdev->vfl_dir != VFL_DIR_M2M) {
202
203 media_devnode_remove(vdev->intf_devnode);
204 if (vdev->entity.function != MEDIA_ENT_F_UNKNOWN)
205 media_device_unregister_entity(&vdev->entity);
206 }
207#endif
208
209
210
211
212
213
214
215
216
217 if (v4l2_dev->release == NULL)
218 v4l2_dev = NULL;
219
220
221
222 vdev->release(vdev);
223
224
225 if (v4l2_dev)
226 v4l2_device_put(v4l2_dev);
227}
228
229static struct class video_class = {
230 .name = VIDEO_NAME,
231 .dev_groups = video_device_groups,
232};
233
234struct video_device *video_devdata(struct file *file)
235{
236 return video_devices[iminor(file_inode(file))];
237}
238EXPORT_SYMBOL(video_devdata);
239
240
241
242
243static inline bool prio_is_valid(enum v4l2_priority prio)
244{
245 return prio == V4L2_PRIORITY_BACKGROUND ||
246 prio == V4L2_PRIORITY_INTERACTIVE ||
247 prio == V4L2_PRIORITY_RECORD;
248}
249
250void v4l2_prio_init(struct v4l2_prio_state *global)
251{
252 memset(global, 0, sizeof(*global));
253}
254EXPORT_SYMBOL(v4l2_prio_init);
255
256int v4l2_prio_change(struct v4l2_prio_state *global, enum v4l2_priority *local,
257 enum v4l2_priority new)
258{
259 if (!prio_is_valid(new))
260 return -EINVAL;
261 if (*local == new)
262 return 0;
263
264 atomic_inc(&global->prios[new]);
265 if (prio_is_valid(*local))
266 atomic_dec(&global->prios[*local]);
267 *local = new;
268 return 0;
269}
270EXPORT_SYMBOL(v4l2_prio_change);
271
272void v4l2_prio_open(struct v4l2_prio_state *global, enum v4l2_priority *local)
273{
274 v4l2_prio_change(global, local, V4L2_PRIORITY_DEFAULT);
275}
276EXPORT_SYMBOL(v4l2_prio_open);
277
278void v4l2_prio_close(struct v4l2_prio_state *global, enum v4l2_priority local)
279{
280 if (prio_is_valid(local))
281 atomic_dec(&global->prios[local]);
282}
283EXPORT_SYMBOL(v4l2_prio_close);
284
285enum v4l2_priority v4l2_prio_max(struct v4l2_prio_state *global)
286{
287 if (atomic_read(&global->prios[V4L2_PRIORITY_RECORD]) > 0)
288 return V4L2_PRIORITY_RECORD;
289 if (atomic_read(&global->prios[V4L2_PRIORITY_INTERACTIVE]) > 0)
290 return V4L2_PRIORITY_INTERACTIVE;
291 if (atomic_read(&global->prios[V4L2_PRIORITY_BACKGROUND]) > 0)
292 return V4L2_PRIORITY_BACKGROUND;
293 return V4L2_PRIORITY_UNSET;
294}
295EXPORT_SYMBOL(v4l2_prio_max);
296
297int v4l2_prio_check(struct v4l2_prio_state *global, enum v4l2_priority local)
298{
299 return (local < v4l2_prio_max(global)) ? -EBUSY : 0;
300}
301EXPORT_SYMBOL(v4l2_prio_check);
302
303
304static ssize_t v4l2_read(struct file *filp, char __user *buf,
305 size_t sz, loff_t *off)
306{
307 struct video_device *vdev = video_devdata(filp);
308 int ret = -ENODEV;
309
310 if (!vdev->fops->read)
311 return -EINVAL;
312 if (video_is_registered(vdev))
313 ret = vdev->fops->read(filp, buf, sz, off);
314 if ((vdev->dev_debug & V4L2_DEV_DEBUG_FOP) &&
315 (vdev->dev_debug & V4L2_DEV_DEBUG_STREAMING))
316 dprintk("%s: read: %zd (%d)\n",
317 video_device_node_name(vdev), sz, ret);
318 return ret;
319}
320
321static ssize_t v4l2_write(struct file *filp, const char __user *buf,
322 size_t sz, loff_t *off)
323{
324 struct video_device *vdev = video_devdata(filp);
325 int ret = -ENODEV;
326
327 if (!vdev->fops->write)
328 return -EINVAL;
329 if (video_is_registered(vdev))
330 ret = vdev->fops->write(filp, buf, sz, off);
331 if ((vdev->dev_debug & V4L2_DEV_DEBUG_FOP) &&
332 (vdev->dev_debug & V4L2_DEV_DEBUG_STREAMING))
333 dprintk("%s: write: %zd (%d)\n",
334 video_device_node_name(vdev), sz, ret);
335 return ret;
336}
337
338static __poll_t v4l2_poll(struct file *filp, struct poll_table_struct *poll)
339{
340 struct video_device *vdev = video_devdata(filp);
341 __poll_t res = EPOLLERR | EPOLLHUP;
342
343 if (!vdev->fops->poll)
344 return DEFAULT_POLLMASK;
345 if (video_is_registered(vdev))
346 res = vdev->fops->poll(filp, poll);
347 if (vdev->dev_debug & V4L2_DEV_DEBUG_POLL)
348 dprintk("%s: poll: %08x\n",
349 video_device_node_name(vdev), res);
350 return res;
351}
352
353static long v4l2_ioctl(struct file *filp, unsigned int cmd, unsigned long arg)
354{
355 struct video_device *vdev = video_devdata(filp);
356 int ret = -ENODEV;
357
358 if (vdev->fops->unlocked_ioctl) {
359 if (video_is_registered(vdev))
360 ret = vdev->fops->unlocked_ioctl(filp, cmd, arg);
361 } else
362 ret = -ENOTTY;
363
364 return ret;
365}
366
367#ifdef CONFIG_MMU
368#define v4l2_get_unmapped_area NULL
369#else
370static unsigned long v4l2_get_unmapped_area(struct file *filp,
371 unsigned long addr, unsigned long len, unsigned long pgoff,
372 unsigned long flags)
373{
374 struct video_device *vdev = video_devdata(filp);
375 int ret;
376
377 if (!vdev->fops->get_unmapped_area)
378 return -ENOSYS;
379 if (!video_is_registered(vdev))
380 return -ENODEV;
381 ret = vdev->fops->get_unmapped_area(filp, addr, len, pgoff, flags);
382 if (vdev->dev_debug & V4L2_DEV_DEBUG_FOP)
383 dprintk("%s: get_unmapped_area (%d)\n",
384 video_device_node_name(vdev), ret);
385 return ret;
386}
387#endif
388
389static int v4l2_mmap(struct file *filp, struct vm_area_struct *vm)
390{
391 struct video_device *vdev = video_devdata(filp);
392 int ret = -ENODEV;
393
394 if (!vdev->fops->mmap)
395 return -ENODEV;
396 if (video_is_registered(vdev))
397 ret = vdev->fops->mmap(filp, vm);
398 if (vdev->dev_debug & V4L2_DEV_DEBUG_FOP)
399 dprintk("%s: mmap (%d)\n",
400 video_device_node_name(vdev), ret);
401 return ret;
402}
403
404
405static int v4l2_open(struct inode *inode, struct file *filp)
406{
407 struct video_device *vdev;
408 int ret = 0;
409
410
411 mutex_lock(&videodev_lock);
412 vdev = video_devdata(filp);
413
414 if (vdev == NULL || !video_is_registered(vdev)) {
415 mutex_unlock(&videodev_lock);
416 return -ENODEV;
417 }
418
419 video_get(vdev);
420 mutex_unlock(&videodev_lock);
421 if (vdev->fops->open) {
422 if (video_is_registered(vdev))
423 ret = vdev->fops->open(filp);
424 else
425 ret = -ENODEV;
426 }
427
428 if (vdev->dev_debug & V4L2_DEV_DEBUG_FOP)
429 dprintk("%s: open (%d)\n",
430 video_device_node_name(vdev), ret);
431
432 if (ret)
433 video_put(vdev);
434 return ret;
435}
436
437
438static int v4l2_release(struct inode *inode, struct file *filp)
439{
440 struct video_device *vdev = video_devdata(filp);
441 int ret = 0;
442
443
444
445
446
447
448
449 if (vdev->fops->release) {
450 if (v4l2_device_supports_requests(vdev->v4l2_dev)) {
451 mutex_lock(&vdev->v4l2_dev->mdev->req_queue_mutex);
452 ret = vdev->fops->release(filp);
453 mutex_unlock(&vdev->v4l2_dev->mdev->req_queue_mutex);
454 } else {
455 ret = vdev->fops->release(filp);
456 }
457 }
458
459 if (vdev->dev_debug & V4L2_DEV_DEBUG_FOP)
460 dprintk("%s: release\n",
461 video_device_node_name(vdev));
462
463
464
465 video_put(vdev);
466 return ret;
467}
468
469static const struct file_operations v4l2_fops = {
470 .owner = THIS_MODULE,
471 .read = v4l2_read,
472 .write = v4l2_write,
473 .open = v4l2_open,
474 .get_unmapped_area = v4l2_get_unmapped_area,
475 .mmap = v4l2_mmap,
476 .unlocked_ioctl = v4l2_ioctl,
477#ifdef CONFIG_COMPAT
478 .compat_ioctl = v4l2_compat_ioctl32,
479#endif
480 .release = v4l2_release,
481 .poll = v4l2_poll,
482 .llseek = no_llseek,
483};
484
485
486
487
488
489
490
491
492
493
494
495
496
497
498static int get_index(struct video_device *vdev)
499{
500
501
502 static DECLARE_BITMAP(used, VIDEO_NUM_DEVICES);
503 int i;
504
505 bitmap_zero(used, VIDEO_NUM_DEVICES);
506
507 for (i = 0; i < VIDEO_NUM_DEVICES; i++) {
508 if (video_devices[i] != NULL &&
509 video_devices[i]->v4l2_dev == vdev->v4l2_dev) {
510 set_bit(video_devices[i]->index, used);
511 }
512 }
513
514 return find_first_zero_bit(used, VIDEO_NUM_DEVICES);
515}
516
517#define SET_VALID_IOCTL(ops, cmd, op) \
518 if (ops->op) \
519 set_bit(_IOC_NR(cmd), valid_ioctls)
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534static void determine_valid_ioctls(struct video_device *vdev)
535{
536 const u32 vid_caps = V4L2_CAP_VIDEO_CAPTURE |
537 V4L2_CAP_VIDEO_CAPTURE_MPLANE |
538 V4L2_CAP_VIDEO_OUTPUT |
539 V4L2_CAP_VIDEO_OUTPUT_MPLANE |
540 V4L2_CAP_VIDEO_M2M | V4L2_CAP_VIDEO_M2M_MPLANE;
541 const u32 meta_caps = V4L2_CAP_META_CAPTURE |
542 V4L2_CAP_META_OUTPUT;
543 DECLARE_BITMAP(valid_ioctls, BASE_VIDIOC_PRIVATE);
544 const struct v4l2_ioctl_ops *ops = vdev->ioctl_ops;
545 bool is_vid = vdev->vfl_type == VFL_TYPE_VIDEO &&
546 (vdev->device_caps & vid_caps);
547 bool is_vbi = vdev->vfl_type == VFL_TYPE_VBI;
548 bool is_radio = vdev->vfl_type == VFL_TYPE_RADIO;
549 bool is_sdr = vdev->vfl_type == VFL_TYPE_SDR;
550 bool is_tch = vdev->vfl_type == VFL_TYPE_TOUCH;
551 bool is_meta = vdev->vfl_type == VFL_TYPE_VIDEO &&
552 (vdev->device_caps & meta_caps);
553 bool is_rx = vdev->vfl_dir != VFL_DIR_TX;
554 bool is_tx = vdev->vfl_dir != VFL_DIR_RX;
555 bool is_io_mc = vdev->device_caps & V4L2_CAP_IO_MC;
556
557 bitmap_zero(valid_ioctls, BASE_VIDIOC_PRIVATE);
558
559
560
561 SET_VALID_IOCTL(ops, VIDIOC_QUERYCAP, vidioc_querycap);
562 set_bit(_IOC_NR(VIDIOC_G_PRIORITY), valid_ioctls);
563 set_bit(_IOC_NR(VIDIOC_S_PRIORITY), valid_ioctls);
564
565
566
567
568
569 if (vdev->ctrl_handler || ops->vidioc_queryctrl)
570 set_bit(_IOC_NR(VIDIOC_QUERYCTRL), valid_ioctls);
571 if (vdev->ctrl_handler || ops->vidioc_query_ext_ctrl)
572 set_bit(_IOC_NR(VIDIOC_QUERY_EXT_CTRL), valid_ioctls);
573 if (vdev->ctrl_handler || ops->vidioc_g_ctrl || ops->vidioc_g_ext_ctrls)
574 set_bit(_IOC_NR(VIDIOC_G_CTRL), valid_ioctls);
575 if (vdev->ctrl_handler || ops->vidioc_s_ctrl || ops->vidioc_s_ext_ctrls)
576 set_bit(_IOC_NR(VIDIOC_S_CTRL), valid_ioctls);
577 if (vdev->ctrl_handler || ops->vidioc_g_ext_ctrls)
578 set_bit(_IOC_NR(VIDIOC_G_EXT_CTRLS), valid_ioctls);
579 if (vdev->ctrl_handler || ops->vidioc_s_ext_ctrls)
580 set_bit(_IOC_NR(VIDIOC_S_EXT_CTRLS), valid_ioctls);
581 if (vdev->ctrl_handler || ops->vidioc_try_ext_ctrls)
582 set_bit(_IOC_NR(VIDIOC_TRY_EXT_CTRLS), valid_ioctls);
583 if (vdev->ctrl_handler || ops->vidioc_querymenu)
584 set_bit(_IOC_NR(VIDIOC_QUERYMENU), valid_ioctls);
585 if (!is_tch) {
586 SET_VALID_IOCTL(ops, VIDIOC_G_FREQUENCY, vidioc_g_frequency);
587 SET_VALID_IOCTL(ops, VIDIOC_S_FREQUENCY, vidioc_s_frequency);
588 }
589 SET_VALID_IOCTL(ops, VIDIOC_LOG_STATUS, vidioc_log_status);
590#ifdef CONFIG_VIDEO_ADV_DEBUG
591 set_bit(_IOC_NR(VIDIOC_DBG_G_CHIP_INFO), valid_ioctls);
592 set_bit(_IOC_NR(VIDIOC_DBG_G_REGISTER), valid_ioctls);
593 set_bit(_IOC_NR(VIDIOC_DBG_S_REGISTER), valid_ioctls);
594#endif
595
596 SET_VALID_IOCTL(ops, VIDIOC_DQEVENT, vidioc_subscribe_event);
597 SET_VALID_IOCTL(ops, VIDIOC_SUBSCRIBE_EVENT, vidioc_subscribe_event);
598 SET_VALID_IOCTL(ops, VIDIOC_UNSUBSCRIBE_EVENT, vidioc_unsubscribe_event);
599 if (ops->vidioc_enum_freq_bands || ops->vidioc_g_tuner || ops->vidioc_g_modulator)
600 set_bit(_IOC_NR(VIDIOC_ENUM_FREQ_BANDS), valid_ioctls);
601
602 if (is_vid) {
603
604 if ((is_rx && (ops->vidioc_enum_fmt_vid_cap ||
605 ops->vidioc_enum_fmt_vid_overlay)) ||
606 (is_tx && ops->vidioc_enum_fmt_vid_out))
607 set_bit(_IOC_NR(VIDIOC_ENUM_FMT), valid_ioctls);
608 if ((is_rx && (ops->vidioc_g_fmt_vid_cap ||
609 ops->vidioc_g_fmt_vid_cap_mplane ||
610 ops->vidioc_g_fmt_vid_overlay)) ||
611 (is_tx && (ops->vidioc_g_fmt_vid_out ||
612 ops->vidioc_g_fmt_vid_out_mplane ||
613 ops->vidioc_g_fmt_vid_out_overlay)))
614 set_bit(_IOC_NR(VIDIOC_G_FMT), valid_ioctls);
615 if ((is_rx && (ops->vidioc_s_fmt_vid_cap ||
616 ops->vidioc_s_fmt_vid_cap_mplane ||
617 ops->vidioc_s_fmt_vid_overlay)) ||
618 (is_tx && (ops->vidioc_s_fmt_vid_out ||
619 ops->vidioc_s_fmt_vid_out_mplane ||
620 ops->vidioc_s_fmt_vid_out_overlay)))
621 set_bit(_IOC_NR(VIDIOC_S_FMT), valid_ioctls);
622 if ((is_rx && (ops->vidioc_try_fmt_vid_cap ||
623 ops->vidioc_try_fmt_vid_cap_mplane ||
624 ops->vidioc_try_fmt_vid_overlay)) ||
625 (is_tx && (ops->vidioc_try_fmt_vid_out ||
626 ops->vidioc_try_fmt_vid_out_mplane ||
627 ops->vidioc_try_fmt_vid_out_overlay)))
628 set_bit(_IOC_NR(VIDIOC_TRY_FMT), valid_ioctls);
629 SET_VALID_IOCTL(ops, VIDIOC_OVERLAY, vidioc_overlay);
630 SET_VALID_IOCTL(ops, VIDIOC_G_FBUF, vidioc_g_fbuf);
631 SET_VALID_IOCTL(ops, VIDIOC_S_FBUF, vidioc_s_fbuf);
632 SET_VALID_IOCTL(ops, VIDIOC_G_JPEGCOMP, vidioc_g_jpegcomp);
633 SET_VALID_IOCTL(ops, VIDIOC_S_JPEGCOMP, vidioc_s_jpegcomp);
634 SET_VALID_IOCTL(ops, VIDIOC_G_ENC_INDEX, vidioc_g_enc_index);
635 SET_VALID_IOCTL(ops, VIDIOC_ENCODER_CMD, vidioc_encoder_cmd);
636 SET_VALID_IOCTL(ops, VIDIOC_TRY_ENCODER_CMD, vidioc_try_encoder_cmd);
637 SET_VALID_IOCTL(ops, VIDIOC_DECODER_CMD, vidioc_decoder_cmd);
638 SET_VALID_IOCTL(ops, VIDIOC_TRY_DECODER_CMD, vidioc_try_decoder_cmd);
639 SET_VALID_IOCTL(ops, VIDIOC_ENUM_FRAMESIZES, vidioc_enum_framesizes);
640 SET_VALID_IOCTL(ops, VIDIOC_ENUM_FRAMEINTERVALS, vidioc_enum_frameintervals);
641 if (ops->vidioc_g_selection) {
642 set_bit(_IOC_NR(VIDIOC_G_CROP), valid_ioctls);
643 set_bit(_IOC_NR(VIDIOC_CROPCAP), valid_ioctls);
644 }
645 if (ops->vidioc_s_selection)
646 set_bit(_IOC_NR(VIDIOC_S_CROP), valid_ioctls);
647 SET_VALID_IOCTL(ops, VIDIOC_G_SELECTION, vidioc_g_selection);
648 SET_VALID_IOCTL(ops, VIDIOC_S_SELECTION, vidioc_s_selection);
649 }
650 if (is_meta && is_rx) {
651
652 SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_meta_cap);
653 SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_meta_cap);
654 SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_meta_cap);
655 SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_meta_cap);
656 } else if (is_meta && is_tx) {
657
658 SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_meta_out);
659 SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_meta_out);
660 SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_meta_out);
661 SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_meta_out);
662 }
663 if (is_vbi) {
664
665 if ((is_rx && (ops->vidioc_g_fmt_vbi_cap ||
666 ops->vidioc_g_fmt_sliced_vbi_cap)) ||
667 (is_tx && (ops->vidioc_g_fmt_vbi_out ||
668 ops->vidioc_g_fmt_sliced_vbi_out)))
669 set_bit(_IOC_NR(VIDIOC_G_FMT), valid_ioctls);
670 if ((is_rx && (ops->vidioc_s_fmt_vbi_cap ||
671 ops->vidioc_s_fmt_sliced_vbi_cap)) ||
672 (is_tx && (ops->vidioc_s_fmt_vbi_out ||
673 ops->vidioc_s_fmt_sliced_vbi_out)))
674 set_bit(_IOC_NR(VIDIOC_S_FMT), valid_ioctls);
675 if ((is_rx && (ops->vidioc_try_fmt_vbi_cap ||
676 ops->vidioc_try_fmt_sliced_vbi_cap)) ||
677 (is_tx && (ops->vidioc_try_fmt_vbi_out ||
678 ops->vidioc_try_fmt_sliced_vbi_out)))
679 set_bit(_IOC_NR(VIDIOC_TRY_FMT), valid_ioctls);
680 SET_VALID_IOCTL(ops, VIDIOC_G_SLICED_VBI_CAP, vidioc_g_sliced_vbi_cap);
681 } else if (is_tch) {
682
683 SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_vid_cap);
684 SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_vid_cap);
685 SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_vid_cap);
686 SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_vid_cap);
687 SET_VALID_IOCTL(ops, VIDIOC_ENUM_FRAMESIZES, vidioc_enum_framesizes);
688 SET_VALID_IOCTL(ops, VIDIOC_ENUM_FRAMEINTERVALS, vidioc_enum_frameintervals);
689 SET_VALID_IOCTL(ops, VIDIOC_ENUMINPUT, vidioc_enum_input);
690 SET_VALID_IOCTL(ops, VIDIOC_G_INPUT, vidioc_g_input);
691 SET_VALID_IOCTL(ops, VIDIOC_S_INPUT, vidioc_s_input);
692 SET_VALID_IOCTL(ops, VIDIOC_G_PARM, vidioc_g_parm);
693 SET_VALID_IOCTL(ops, VIDIOC_S_PARM, vidioc_s_parm);
694 } else if (is_sdr && is_rx) {
695
696 SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_sdr_cap);
697 SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_sdr_cap);
698 SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_sdr_cap);
699 SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_sdr_cap);
700 } else if (is_sdr && is_tx) {
701
702 SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_sdr_out);
703 SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_sdr_out);
704 SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_sdr_out);
705 SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_sdr_out);
706 }
707
708 if (is_vid || is_vbi || is_sdr || is_tch || is_meta) {
709
710 SET_VALID_IOCTL(ops, VIDIOC_REQBUFS, vidioc_reqbufs);
711 SET_VALID_IOCTL(ops, VIDIOC_QUERYBUF, vidioc_querybuf);
712 SET_VALID_IOCTL(ops, VIDIOC_QBUF, vidioc_qbuf);
713 SET_VALID_IOCTL(ops, VIDIOC_EXPBUF, vidioc_expbuf);
714 SET_VALID_IOCTL(ops, VIDIOC_DQBUF, vidioc_dqbuf);
715 SET_VALID_IOCTL(ops, VIDIOC_CREATE_BUFS, vidioc_create_bufs);
716 SET_VALID_IOCTL(ops, VIDIOC_PREPARE_BUF, vidioc_prepare_buf);
717 SET_VALID_IOCTL(ops, VIDIOC_STREAMON, vidioc_streamon);
718 SET_VALID_IOCTL(ops, VIDIOC_STREAMOFF, vidioc_streamoff);
719 }
720
721 if (is_vid || is_vbi || is_meta) {
722
723 if (ops->vidioc_s_std)
724 set_bit(_IOC_NR(VIDIOC_ENUMSTD), valid_ioctls);
725 SET_VALID_IOCTL(ops, VIDIOC_S_STD, vidioc_s_std);
726 SET_VALID_IOCTL(ops, VIDIOC_G_STD, vidioc_g_std);
727 if (is_rx) {
728 SET_VALID_IOCTL(ops, VIDIOC_QUERYSTD, vidioc_querystd);
729 if (is_io_mc) {
730 set_bit(_IOC_NR(VIDIOC_ENUMINPUT), valid_ioctls);
731 set_bit(_IOC_NR(VIDIOC_G_INPUT), valid_ioctls);
732 set_bit(_IOC_NR(VIDIOC_S_INPUT), valid_ioctls);
733 } else {
734 SET_VALID_IOCTL(ops, VIDIOC_ENUMINPUT, vidioc_enum_input);
735 SET_VALID_IOCTL(ops, VIDIOC_G_INPUT, vidioc_g_input);
736 SET_VALID_IOCTL(ops, VIDIOC_S_INPUT, vidioc_s_input);
737 }
738 SET_VALID_IOCTL(ops, VIDIOC_ENUMAUDIO, vidioc_enumaudio);
739 SET_VALID_IOCTL(ops, VIDIOC_G_AUDIO, vidioc_g_audio);
740 SET_VALID_IOCTL(ops, VIDIOC_S_AUDIO, vidioc_s_audio);
741 SET_VALID_IOCTL(ops, VIDIOC_QUERY_DV_TIMINGS, vidioc_query_dv_timings);
742 SET_VALID_IOCTL(ops, VIDIOC_S_EDID, vidioc_s_edid);
743 }
744 if (is_tx) {
745 if (is_io_mc) {
746 set_bit(_IOC_NR(VIDIOC_ENUMOUTPUT), valid_ioctls);
747 set_bit(_IOC_NR(VIDIOC_G_OUTPUT), valid_ioctls);
748 set_bit(_IOC_NR(VIDIOC_S_OUTPUT), valid_ioctls);
749 } else {
750 SET_VALID_IOCTL(ops, VIDIOC_ENUMOUTPUT, vidioc_enum_output);
751 SET_VALID_IOCTL(ops, VIDIOC_G_OUTPUT, vidioc_g_output);
752 SET_VALID_IOCTL(ops, VIDIOC_S_OUTPUT, vidioc_s_output);
753 }
754 SET_VALID_IOCTL(ops, VIDIOC_ENUMAUDOUT, vidioc_enumaudout);
755 SET_VALID_IOCTL(ops, VIDIOC_G_AUDOUT, vidioc_g_audout);
756 SET_VALID_IOCTL(ops, VIDIOC_S_AUDOUT, vidioc_s_audout);
757 }
758 if (ops->vidioc_g_parm || ops->vidioc_g_std)
759 set_bit(_IOC_NR(VIDIOC_G_PARM), valid_ioctls);
760 SET_VALID_IOCTL(ops, VIDIOC_S_PARM, vidioc_s_parm);
761 SET_VALID_IOCTL(ops, VIDIOC_S_DV_TIMINGS, vidioc_s_dv_timings);
762 SET_VALID_IOCTL(ops, VIDIOC_G_DV_TIMINGS, vidioc_g_dv_timings);
763 SET_VALID_IOCTL(ops, VIDIOC_ENUM_DV_TIMINGS, vidioc_enum_dv_timings);
764 SET_VALID_IOCTL(ops, VIDIOC_DV_TIMINGS_CAP, vidioc_dv_timings_cap);
765 SET_VALID_IOCTL(ops, VIDIOC_G_EDID, vidioc_g_edid);
766 }
767 if (is_tx && (is_radio || is_sdr)) {
768
769 SET_VALID_IOCTL(ops, VIDIOC_G_MODULATOR, vidioc_g_modulator);
770 SET_VALID_IOCTL(ops, VIDIOC_S_MODULATOR, vidioc_s_modulator);
771 }
772 if (is_rx && !is_tch) {
773
774 SET_VALID_IOCTL(ops, VIDIOC_G_TUNER, vidioc_g_tuner);
775 SET_VALID_IOCTL(ops, VIDIOC_S_TUNER, vidioc_s_tuner);
776 SET_VALID_IOCTL(ops, VIDIOC_S_HW_FREQ_SEEK, vidioc_s_hw_freq_seek);
777 }
778
779 bitmap_andnot(vdev->valid_ioctls, valid_ioctls, vdev->valid_ioctls,
780 BASE_VIDIOC_PRIVATE);
781}
782
783static int video_register_media_controller(struct video_device *vdev)
784{
785#if defined(CONFIG_MEDIA_CONTROLLER)
786 u32 intf_type;
787 int ret;
788
789
790
791
792 if (!vdev->v4l2_dev->mdev || vdev->vfl_dir == VFL_DIR_M2M)
793 return 0;
794
795 vdev->entity.obj_type = MEDIA_ENTITY_TYPE_VIDEO_DEVICE;
796 vdev->entity.function = MEDIA_ENT_F_UNKNOWN;
797
798 switch (vdev->vfl_type) {
799 case VFL_TYPE_VIDEO:
800 intf_type = MEDIA_INTF_T_V4L_VIDEO;
801 vdev->entity.function = MEDIA_ENT_F_IO_V4L;
802 break;
803 case VFL_TYPE_VBI:
804 intf_type = MEDIA_INTF_T_V4L_VBI;
805 vdev->entity.function = MEDIA_ENT_F_IO_VBI;
806 break;
807 case VFL_TYPE_SDR:
808 intf_type = MEDIA_INTF_T_V4L_SWRADIO;
809 vdev->entity.function = MEDIA_ENT_F_IO_SWRADIO;
810 break;
811 case VFL_TYPE_TOUCH:
812 intf_type = MEDIA_INTF_T_V4L_TOUCH;
813 vdev->entity.function = MEDIA_ENT_F_IO_V4L;
814 break;
815 case VFL_TYPE_RADIO:
816 intf_type = MEDIA_INTF_T_V4L_RADIO;
817
818
819
820
821
822 break;
823 case VFL_TYPE_SUBDEV:
824 intf_type = MEDIA_INTF_T_V4L_SUBDEV;
825
826 break;
827 default:
828 return 0;
829 }
830
831 if (vdev->entity.function != MEDIA_ENT_F_UNKNOWN) {
832 vdev->entity.name = vdev->name;
833
834
835 vdev->entity.info.dev.major = VIDEO_MAJOR;
836 vdev->entity.info.dev.minor = vdev->minor;
837
838 ret = media_device_register_entity(vdev->v4l2_dev->mdev,
839 &vdev->entity);
840 if (ret < 0) {
841 pr_warn("%s: media_device_register_entity failed\n",
842 __func__);
843 return ret;
844 }
845 }
846
847 vdev->intf_devnode = media_devnode_create(vdev->v4l2_dev->mdev,
848 intf_type,
849 0, VIDEO_MAJOR,
850 vdev->minor);
851 if (!vdev->intf_devnode) {
852 media_device_unregister_entity(&vdev->entity);
853 return -ENOMEM;
854 }
855
856 if (vdev->entity.function != MEDIA_ENT_F_UNKNOWN) {
857 struct media_link *link;
858
859 link = media_create_intf_link(&vdev->entity,
860 &vdev->intf_devnode->intf,
861 MEDIA_LNK_FL_ENABLED |
862 MEDIA_LNK_FL_IMMUTABLE);
863 if (!link) {
864 media_devnode_remove(vdev->intf_devnode);
865 media_device_unregister_entity(&vdev->entity);
866 return -ENOMEM;
867 }
868 }
869
870
871
872#endif
873 return 0;
874}
875
876int __video_register_device(struct video_device *vdev,
877 enum vfl_devnode_type type,
878 int nr, int warn_if_nr_in_use,
879 struct module *owner)
880{
881 int i = 0;
882 int ret;
883 int minor_offset = 0;
884 int minor_cnt = VIDEO_NUM_DEVICES;
885 const char *name_base;
886
887
888
889 vdev->minor = -1;
890
891
892 if (WARN_ON(!vdev->release))
893 return -EINVAL;
894
895 if (WARN_ON(!vdev->v4l2_dev))
896 return -EINVAL;
897
898 if (WARN_ON(type != VFL_TYPE_SUBDEV && !vdev->device_caps))
899 return -EINVAL;
900
901
902 spin_lock_init(&vdev->fh_lock);
903 INIT_LIST_HEAD(&vdev->fh_list);
904
905
906 switch (type) {
907 case VFL_TYPE_VIDEO:
908 name_base = "video";
909 break;
910 case VFL_TYPE_VBI:
911 name_base = "vbi";
912 break;
913 case VFL_TYPE_RADIO:
914 name_base = "radio";
915 break;
916 case VFL_TYPE_SUBDEV:
917 name_base = "v4l-subdev";
918 break;
919 case VFL_TYPE_SDR:
920
921 name_base = "swradio";
922 break;
923 case VFL_TYPE_TOUCH:
924 name_base = "v4l-touch";
925 break;
926 default:
927 pr_err("%s called with unknown type: %d\n",
928 __func__, type);
929 return -EINVAL;
930 }
931
932 vdev->vfl_type = type;
933 vdev->cdev = NULL;
934 if (vdev->dev_parent == NULL)
935 vdev->dev_parent = vdev->v4l2_dev->dev;
936 if (vdev->ctrl_handler == NULL)
937 vdev->ctrl_handler = vdev->v4l2_dev->ctrl_handler;
938
939
940 if (vdev->prio == NULL)
941 vdev->prio = &vdev->v4l2_dev->prio;
942
943
944#ifdef CONFIG_VIDEO_FIXED_MINOR_RANGES
945
946
947
948
949
950 switch (type) {
951 case VFL_TYPE_VIDEO:
952 minor_offset = 0;
953 minor_cnt = 64;
954 break;
955 case VFL_TYPE_RADIO:
956 minor_offset = 64;
957 minor_cnt = 64;
958 break;
959 case VFL_TYPE_VBI:
960 minor_offset = 224;
961 minor_cnt = 32;
962 break;
963 default:
964 minor_offset = 128;
965 minor_cnt = 64;
966 break;
967 }
968#endif
969
970
971 mutex_lock(&videodev_lock);
972 nr = devnode_find(vdev, nr == -1 ? 0 : nr, minor_cnt);
973 if (nr == minor_cnt)
974 nr = devnode_find(vdev, 0, minor_cnt);
975 if (nr == minor_cnt) {
976 pr_err("could not get a free device node number\n");
977 mutex_unlock(&videodev_lock);
978 return -ENFILE;
979 }
980#ifdef CONFIG_VIDEO_FIXED_MINOR_RANGES
981
982 i = nr;
983#else
984
985
986 for (i = 0; i < VIDEO_NUM_DEVICES; i++)
987 if (video_devices[i] == NULL)
988 break;
989 if (i == VIDEO_NUM_DEVICES) {
990 mutex_unlock(&videodev_lock);
991 pr_err("could not get a free minor\n");
992 return -ENFILE;
993 }
994#endif
995 vdev->minor = i + minor_offset;
996 vdev->num = nr;
997
998
999 if (WARN_ON(video_devices[vdev->minor])) {
1000 mutex_unlock(&videodev_lock);
1001 pr_err("video_device not empty!\n");
1002 return -ENFILE;
1003 }
1004 devnode_set(vdev);
1005 vdev->index = get_index(vdev);
1006 video_devices[vdev->minor] = vdev;
1007 mutex_unlock(&videodev_lock);
1008
1009 if (vdev->ioctl_ops)
1010 determine_valid_ioctls(vdev);
1011
1012
1013 vdev->cdev = cdev_alloc();
1014 if (vdev->cdev == NULL) {
1015 ret = -ENOMEM;
1016 goto cleanup;
1017 }
1018 vdev->cdev->ops = &v4l2_fops;
1019 vdev->cdev->owner = owner;
1020 ret = cdev_add(vdev->cdev, MKDEV(VIDEO_MAJOR, vdev->minor), 1);
1021 if (ret < 0) {
1022 pr_err("%s: cdev_add failed\n", __func__);
1023 kfree(vdev->cdev);
1024 vdev->cdev = NULL;
1025 goto cleanup;
1026 }
1027
1028
1029 vdev->dev.class = &video_class;
1030 vdev->dev.devt = MKDEV(VIDEO_MAJOR, vdev->minor);
1031 vdev->dev.parent = vdev->dev_parent;
1032 dev_set_name(&vdev->dev, "%s%d", name_base, vdev->num);
1033 ret = device_register(&vdev->dev);
1034 if (ret < 0) {
1035 pr_err("%s: device_register failed\n", __func__);
1036 goto cleanup;
1037 }
1038
1039
1040 vdev->dev.release = v4l2_device_release;
1041
1042 if (nr != -1 && nr != vdev->num && warn_if_nr_in_use)
1043 pr_warn("%s: requested %s%d, got %s\n", __func__,
1044 name_base, nr, video_device_node_name(vdev));
1045
1046
1047 v4l2_device_get(vdev->v4l2_dev);
1048
1049
1050 ret = video_register_media_controller(vdev);
1051
1052
1053 set_bit(V4L2_FL_REGISTERED, &vdev->flags);
1054
1055 return 0;
1056
1057cleanup:
1058 mutex_lock(&videodev_lock);
1059 if (vdev->cdev)
1060 cdev_del(vdev->cdev);
1061 video_devices[vdev->minor] = NULL;
1062 devnode_clear(vdev);
1063 mutex_unlock(&videodev_lock);
1064
1065 vdev->minor = -1;
1066 return ret;
1067}
1068EXPORT_SYMBOL(__video_register_device);
1069
1070
1071
1072
1073
1074
1075
1076
1077void video_unregister_device(struct video_device *vdev)
1078{
1079
1080 if (!vdev || !video_is_registered(vdev))
1081 return;
1082
1083 mutex_lock(&videodev_lock);
1084
1085
1086
1087 clear_bit(V4L2_FL_REGISTERED, &vdev->flags);
1088 mutex_unlock(&videodev_lock);
1089 device_unregister(&vdev->dev);
1090}
1091EXPORT_SYMBOL(video_unregister_device);
1092
1093
1094
1095
1096static int __init videodev_init(void)
1097{
1098 dev_t dev = MKDEV(VIDEO_MAJOR, 0);
1099 int ret;
1100
1101 pr_info("Linux video capture interface: v2.00\n");
1102 ret = register_chrdev_region(dev, VIDEO_NUM_DEVICES, VIDEO_NAME);
1103 if (ret < 0) {
1104 pr_warn("videodev: unable to get major %d\n",
1105 VIDEO_MAJOR);
1106 return ret;
1107 }
1108
1109 ret = class_register(&video_class);
1110 if (ret < 0) {
1111 unregister_chrdev_region(dev, VIDEO_NUM_DEVICES);
1112 pr_warn("video_dev: class_register failed\n");
1113 return -EIO;
1114 }
1115
1116 return 0;
1117}
1118
1119static void __exit videodev_exit(void)
1120{
1121 dev_t dev = MKDEV(VIDEO_MAJOR, 0);
1122
1123 class_unregister(&video_class);
1124 unregister_chrdev_region(dev, VIDEO_NUM_DEVICES);
1125}
1126
1127subsys_initcall(videodev_init);
1128module_exit(videodev_exit)
1129
1130MODULE_AUTHOR("Alan Cox, Mauro Carvalho Chehab <mchehab@kernel.org>, Bill Dirks, Justin Schoeman, Gerd Knorr");
1131MODULE_DESCRIPTION("Video4Linux2 core driver");
1132MODULE_LICENSE("GPL");
1133MODULE_ALIAS_CHARDEV_MAJOR(VIDEO_MAJOR);
1134