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