| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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. */ |
| 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. */ |
| 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 */ |
| 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 */ |
| 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> */ |
| 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 | |
| 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 | |
| 151 | void video_device_release(struct video_device *vdev) |
| 152 | { |
| 153 | kfree(vdev); |
| 154 | } |
| 155 | EXPORT_SYMBOL(video_device_release); |
| 156 | |
| 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 | |
| 164 | static inline void video_get(struct video_device *vdev) |
| 165 | { |
| 166 | get_device(&vdev->dev); |
| 167 | } |
| 168 | |
| 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. */ |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 | |
| 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 |
| 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 | |
| 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 */ |
| 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 */ |
| 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 | }; |
| 487 | |
| 488 | /** |
| 489 | * get_index - assign stream index number based on v4l2_dev |
| 490 | * @vdev: video_device to assign index number to, vdev->v4l2_dev should be assigned |
| 491 | * |
| 492 | * Note that when this is called the new device has not yet been registered |
| 493 | * in the video_device array, but it was able to obtain a minor number. |
| 494 | * |
| 495 | * This means that we can always obtain a free stream index number since |
| 496 | * the worst case scenario is that there are VIDEO_NUM_DEVICES - 1 slots in |
| 497 | * use of the video_device array. |
| 498 | * |
| 499 | * Returns a free index number. |
| 500 | */ |
| 501 | static int get_index(struct video_device *vdev) |
| 502 | { |
| 503 | /* This can be static since this function is called with the global |
| 504 | videodev_lock held. */ |
| 505 | static DECLARE_BITMAP(used, VIDEO_NUM_DEVICES); |
| 506 | int i; |
| 507 | |
| 508 | bitmap_zero(used, VIDEO_NUM_DEVICES); |
| 509 | |
| 510 | for (i = 0; i < VIDEO_NUM_DEVICES; i++) { |
| 511 | if (video_devices[i] != NULL && |
| 512 | video_devices[i]->v4l2_dev == vdev->v4l2_dev) { |
| 513 | __set_bit(video_devices[i]->index, used); |
| 514 | } |
| 515 | } |
| 516 | |
| 517 | return find_first_zero_bit(used, VIDEO_NUM_DEVICES); |
| 518 | } |
| 519 | |
| 520 | #define SET_VALID_IOCTL(ops, cmd, op) \ |
| 521 | do { if ((ops)->op) __set_bit(_IOC_NR(cmd), valid_ioctls); } while (0) |
| 522 | |
| 523 | /* This determines which ioctls are actually implemented in the driver. |
| 524 | It's a one-time thing which simplifies video_ioctl2 as it can just do |
| 525 | a bit test. |
| 526 | |
| 527 | Note that drivers can override this by setting bits to 1 in |
| 528 | vdev->valid_ioctls. If an ioctl is marked as 1 when this function is |
| 529 | called, then that ioctl will actually be marked as unimplemented. |
| 530 | |
| 531 | It does that by first setting up the local valid_ioctls bitmap, and |
| 532 | at the end do a: |
| 533 | |
| 534 | vdev->valid_ioctls = valid_ioctls & ~(vdev->valid_ioctls) |
| 535 | */ |
| 536 | static void determine_valid_ioctls(struct video_device *vdev) |
| 537 | { |
| 538 | const u32 vid_caps = V4L2_CAP_VIDEO_CAPTURE | |
| 539 | V4L2_CAP_VIDEO_CAPTURE_MPLANE | |
| 540 | V4L2_CAP_VIDEO_OUTPUT | |
| 541 | V4L2_CAP_VIDEO_OUTPUT_MPLANE | |
| 542 | V4L2_CAP_VIDEO_M2M | V4L2_CAP_VIDEO_M2M_MPLANE; |
| 543 | const u32 meta_caps = V4L2_CAP_META_CAPTURE | |
| 544 | V4L2_CAP_META_OUTPUT; |
| 545 | DECLARE_BITMAP(valid_ioctls, BASE_VIDIOC_PRIVATE); |
| 546 | const struct v4l2_ioctl_ops *ops = vdev->ioctl_ops; |
| 547 | bool is_vid = vdev->vfl_type == VFL_TYPE_VIDEO && |
| 548 | (vdev->device_caps & vid_caps); |
| 549 | bool is_vbi = vdev->vfl_type == VFL_TYPE_VBI; |
| 550 | bool is_radio = vdev->vfl_type == VFL_TYPE_RADIO; |
| 551 | bool is_sdr = vdev->vfl_type == VFL_TYPE_SDR; |
| 552 | bool is_tch = vdev->vfl_type == VFL_TYPE_TOUCH; |
| 553 | bool is_meta = vdev->vfl_type == VFL_TYPE_VIDEO && |
| 554 | (vdev->device_caps & meta_caps); |
| 555 | bool is_rx = vdev->vfl_dir != VFL_DIR_TX; |
| 556 | bool is_tx = vdev->vfl_dir != VFL_DIR_RX; |
| 557 | bool is_io_mc = vdev->device_caps & V4L2_CAP_IO_MC; |
| 558 | bool has_streaming = vdev->device_caps & V4L2_CAP_STREAMING; |
| 559 | bool is_edid = vdev->device_caps & V4L2_CAP_EDID; |
| 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 | !test_bit(_IOC_NR(VIDIOC_G_SELECTION), vdev->valid_ioctls)) { |
| 647 | __set_bit(_IOC_NR(VIDIOC_G_CROP), valid_ioctls); |
| 648 | __set_bit(_IOC_NR(VIDIOC_CROPCAP), valid_ioctls); |
| 649 | } |
| 650 | if (ops->vidioc_s_selection && |
| 651 | !test_bit(_IOC_NR(VIDIOC_S_SELECTION), vdev->valid_ioctls)) |
| 652 | __set_bit(_IOC_NR(VIDIOC_S_CROP), valid_ioctls); |
| 653 | SET_VALID_IOCTL(ops, VIDIOC_G_SELECTION, vidioc_g_selection); |
| 654 | SET_VALID_IOCTL(ops, VIDIOC_S_SELECTION, vidioc_s_selection); |
| 655 | } |
| 656 | if (is_meta && is_rx) { |
| 657 | /* metadata capture specific ioctls */ |
| 658 | SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_meta_cap); |
| 659 | SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_meta_cap); |
| 660 | SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_meta_cap); |
| 661 | SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_meta_cap); |
| 662 | } else if (is_meta && is_tx) { |
| 663 | /* metadata output specific ioctls */ |
| 664 | SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_meta_out); |
| 665 | SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_meta_out); |
| 666 | SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_meta_out); |
| 667 | SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_meta_out); |
| 668 | } |
| 669 | if (is_vbi) { |
| 670 | /* vbi specific ioctls */ |
| 671 | if ((is_rx && (ops->vidioc_g_fmt_vbi_cap || |
| 672 | ops->vidioc_g_fmt_sliced_vbi_cap)) || |
| 673 | (is_tx && (ops->vidioc_g_fmt_vbi_out || |
| 674 | ops->vidioc_g_fmt_sliced_vbi_out))) |
| 675 | __set_bit(_IOC_NR(VIDIOC_G_FMT), valid_ioctls); |
| 676 | if ((is_rx && (ops->vidioc_s_fmt_vbi_cap || |
| 677 | ops->vidioc_s_fmt_sliced_vbi_cap)) || |
| 678 | (is_tx && (ops->vidioc_s_fmt_vbi_out || |
| 679 | ops->vidioc_s_fmt_sliced_vbi_out))) |
| 680 | __set_bit(_IOC_NR(VIDIOC_S_FMT), valid_ioctls); |
| 681 | if ((is_rx && (ops->vidioc_try_fmt_vbi_cap || |
| 682 | ops->vidioc_try_fmt_sliced_vbi_cap)) || |
| 683 | (is_tx && (ops->vidioc_try_fmt_vbi_out || |
| 684 | ops->vidioc_try_fmt_sliced_vbi_out))) |
| 685 | __set_bit(_IOC_NR(VIDIOC_TRY_FMT), valid_ioctls); |
| 686 | SET_VALID_IOCTL(ops, VIDIOC_G_SLICED_VBI_CAP, vidioc_g_sliced_vbi_cap); |
| 687 | } else if (is_tch) { |
| 688 | /* touch specific ioctls */ |
| 689 | SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_vid_cap); |
| 690 | SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_vid_cap); |
| 691 | SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_vid_cap); |
| 692 | SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_vid_cap); |
| 693 | SET_VALID_IOCTL(ops, VIDIOC_ENUM_FRAMESIZES, vidioc_enum_framesizes); |
| 694 | SET_VALID_IOCTL(ops, VIDIOC_ENUM_FRAMEINTERVALS, vidioc_enum_frameintervals); |
| 695 | SET_VALID_IOCTL(ops, VIDIOC_ENUMINPUT, vidioc_enum_input); |
| 696 | SET_VALID_IOCTL(ops, VIDIOC_G_INPUT, vidioc_g_input); |
| 697 | SET_VALID_IOCTL(ops, VIDIOC_S_INPUT, vidioc_s_input); |
| 698 | SET_VALID_IOCTL(ops, VIDIOC_G_PARM, vidioc_g_parm); |
| 699 | SET_VALID_IOCTL(ops, VIDIOC_S_PARM, vidioc_s_parm); |
| 700 | } else if (is_sdr && is_rx) { |
| 701 | /* SDR receiver specific ioctls */ |
| 702 | SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_sdr_cap); |
| 703 | SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_sdr_cap); |
| 704 | SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_sdr_cap); |
| 705 | SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_sdr_cap); |
| 706 | } else if (is_sdr && is_tx) { |
| 707 | /* SDR transmitter specific ioctls */ |
| 708 | SET_VALID_IOCTL(ops, VIDIOC_ENUM_FMT, vidioc_enum_fmt_sdr_out); |
| 709 | SET_VALID_IOCTL(ops, VIDIOC_G_FMT, vidioc_g_fmt_sdr_out); |
| 710 | SET_VALID_IOCTL(ops, VIDIOC_S_FMT, vidioc_s_fmt_sdr_out); |
| 711 | SET_VALID_IOCTL(ops, VIDIOC_TRY_FMT, vidioc_try_fmt_sdr_out); |
| 712 | } |
| 713 | |
| 714 | if (has_streaming) { |
| 715 | /* ioctls valid for streaming I/O */ |
| 716 | SET_VALID_IOCTL(ops, VIDIOC_REQBUFS, vidioc_reqbufs); |
| 717 | SET_VALID_IOCTL(ops, VIDIOC_QUERYBUF, vidioc_querybuf); |
| 718 | SET_VALID_IOCTL(ops, VIDIOC_QBUF, vidioc_qbuf); |
| 719 | SET_VALID_IOCTL(ops, VIDIOC_EXPBUF, vidioc_expbuf); |
| 720 | SET_VALID_IOCTL(ops, VIDIOC_DQBUF, vidioc_dqbuf); |
| 721 | SET_VALID_IOCTL(ops, VIDIOC_CREATE_BUFS, vidioc_create_bufs); |
| 722 | SET_VALID_IOCTL(ops, VIDIOC_PREPARE_BUF, vidioc_prepare_buf); |
| 723 | SET_VALID_IOCTL(ops, VIDIOC_STREAMON, vidioc_streamon); |
| 724 | SET_VALID_IOCTL(ops, VIDIOC_STREAMOFF, vidioc_streamoff); |
| 725 | /* VIDIOC_CREATE_BUFS support is mandatory to enable VIDIOC_REMOVE_BUFS */ |
| 726 | if (ops->vidioc_create_bufs) |
| 727 | SET_VALID_IOCTL(ops, VIDIOC_REMOVE_BUFS, vidioc_remove_bufs); |
| 728 | } |
| 729 | |
| 730 | if (is_vid || is_vbi || is_meta) { |
| 731 | /* ioctls valid for video, vbi and metadata */ |
| 732 | if (ops->vidioc_s_std) |
| 733 | __set_bit(_IOC_NR(VIDIOC_ENUMSTD), valid_ioctls); |
| 734 | SET_VALID_IOCTL(ops, VIDIOC_S_STD, vidioc_s_std); |
| 735 | SET_VALID_IOCTL(ops, VIDIOC_G_STD, vidioc_g_std); |
| 736 | if (is_rx) { |
| 737 | SET_VALID_IOCTL(ops, VIDIOC_QUERYSTD, vidioc_querystd); |
| 738 | if (is_io_mc) { |
| 739 | __set_bit(_IOC_NR(VIDIOC_ENUMINPUT), valid_ioctls); |
| 740 | __set_bit(_IOC_NR(VIDIOC_G_INPUT), valid_ioctls); |
| 741 | __set_bit(_IOC_NR(VIDIOC_S_INPUT), valid_ioctls); |
| 742 | } else { |
| 743 | SET_VALID_IOCTL(ops, VIDIOC_ENUMINPUT, vidioc_enum_input); |
| 744 | SET_VALID_IOCTL(ops, VIDIOC_G_INPUT, vidioc_g_input); |
| 745 | SET_VALID_IOCTL(ops, VIDIOC_S_INPUT, vidioc_s_input); |
| 746 | } |
| 747 | SET_VALID_IOCTL(ops, VIDIOC_ENUMAUDIO, vidioc_enumaudio); |
| 748 | SET_VALID_IOCTL(ops, VIDIOC_G_AUDIO, vidioc_g_audio); |
| 749 | SET_VALID_IOCTL(ops, VIDIOC_S_AUDIO, vidioc_s_audio); |
| 750 | SET_VALID_IOCTL(ops, VIDIOC_QUERY_DV_TIMINGS, vidioc_query_dv_timings); |
| 751 | SET_VALID_IOCTL(ops, VIDIOC_S_EDID, vidioc_s_edid); |
| 752 | } |
| 753 | if (is_tx) { |
| 754 | if (is_io_mc) { |
| 755 | __set_bit(_IOC_NR(VIDIOC_ENUMOUTPUT), valid_ioctls); |
| 756 | __set_bit(_IOC_NR(VIDIOC_G_OUTPUT), valid_ioctls); |
| 757 | __set_bit(_IOC_NR(VIDIOC_S_OUTPUT), valid_ioctls); |
| 758 | } else { |
| 759 | SET_VALID_IOCTL(ops, VIDIOC_ENUMOUTPUT, vidioc_enum_output); |
| 760 | SET_VALID_IOCTL(ops, VIDIOC_G_OUTPUT, vidioc_g_output); |
| 761 | SET_VALID_IOCTL(ops, VIDIOC_S_OUTPUT, vidioc_s_output); |
| 762 | } |
| 763 | SET_VALID_IOCTL(ops, VIDIOC_ENUMAUDOUT, vidioc_enumaudout); |
| 764 | SET_VALID_IOCTL(ops, VIDIOC_G_AUDOUT, vidioc_g_audout); |
| 765 | SET_VALID_IOCTL(ops, VIDIOC_S_AUDOUT, vidioc_s_audout); |
| 766 | } |
| 767 | if (ops->vidioc_g_parm || ops->vidioc_g_std) |
| 768 | __set_bit(_IOC_NR(VIDIOC_G_PARM), valid_ioctls); |
| 769 | SET_VALID_IOCTL(ops, VIDIOC_S_PARM, vidioc_s_parm); |
| 770 | SET_VALID_IOCTL(ops, VIDIOC_S_DV_TIMINGS, vidioc_s_dv_timings); |
| 771 | SET_VALID_IOCTL(ops, VIDIOC_G_DV_TIMINGS, vidioc_g_dv_timings); |
| 772 | SET_VALID_IOCTL(ops, VIDIOC_ENUM_DV_TIMINGS, vidioc_enum_dv_timings); |
| 773 | SET_VALID_IOCTL(ops, VIDIOC_DV_TIMINGS_CAP, vidioc_dv_timings_cap); |
| 774 | SET_VALID_IOCTL(ops, VIDIOC_G_EDID, vidioc_g_edid); |
| 775 | } |
| 776 | if (is_tx && (is_radio || is_sdr)) { |
| 777 | /* radio transmitter only ioctls */ |
| 778 | SET_VALID_IOCTL(ops, VIDIOC_G_MODULATOR, vidioc_g_modulator); |
| 779 | SET_VALID_IOCTL(ops, VIDIOC_S_MODULATOR, vidioc_s_modulator); |
| 780 | } |
| 781 | if (is_rx && !is_tch) { |
| 782 | /* receiver only ioctls */ |
| 783 | SET_VALID_IOCTL(ops, VIDIOC_G_TUNER, vidioc_g_tuner); |
| 784 | SET_VALID_IOCTL(ops, VIDIOC_S_TUNER, vidioc_s_tuner); |
| 785 | SET_VALID_IOCTL(ops, VIDIOC_S_HW_FREQ_SEEK, vidioc_s_hw_freq_seek); |
| 786 | } |
| 787 | if (is_edid) { |
| 788 | SET_VALID_IOCTL(ops, VIDIOC_G_EDID, vidioc_g_edid); |
| 789 | if (is_tx) { |
| 790 | SET_VALID_IOCTL(ops, VIDIOC_G_OUTPUT, vidioc_g_output); |
| 791 | SET_VALID_IOCTL(ops, VIDIOC_S_OUTPUT, vidioc_s_output); |
| 792 | SET_VALID_IOCTL(ops, VIDIOC_ENUMOUTPUT, vidioc_enum_output); |
| 793 | } |
| 794 | if (is_rx) { |
| 795 | SET_VALID_IOCTL(ops, VIDIOC_ENUMINPUT, vidioc_enum_input); |
| 796 | SET_VALID_IOCTL(ops, VIDIOC_G_INPUT, vidioc_g_input); |
| 797 | SET_VALID_IOCTL(ops, VIDIOC_S_INPUT, vidioc_s_input); |
| 798 | SET_VALID_IOCTL(ops, VIDIOC_S_EDID, vidioc_s_edid); |
| 799 | } |
| 800 | } |
| 801 | |
| 802 | bitmap_andnot(vdev->valid_ioctls, valid_ioctls, vdev->valid_ioctls, |
| 803 | BASE_VIDIOC_PRIVATE); |
| 804 | } |
| 805 | |
| 806 | static int video_register_media_controller(struct video_device *vdev) |
| 807 | { |
| 808 | #if defined(CONFIG_MEDIA_CONTROLLER) |
| 809 | u32 intf_type; |
| 810 | int ret; |
| 811 | |
| 812 | /* Memory-to-memory devices are more complex and use |
| 813 | * their own function to register its mc entities. |
| 814 | */ |
| 815 | if (!vdev->v4l2_dev->mdev || vdev->vfl_dir == VFL_DIR_M2M) |
| 816 | return 0; |
| 817 | |
| 818 | vdev->entity.obj_type = MEDIA_ENTITY_TYPE_VIDEO_DEVICE; |
| 819 | vdev->entity.function = MEDIA_ENT_F_UNKNOWN; |
| 820 | |
| 821 | switch (vdev->vfl_type) { |
| 822 | case VFL_TYPE_VIDEO: |
| 823 | intf_type = MEDIA_INTF_T_V4L_VIDEO; |
| 824 | vdev->entity.function = MEDIA_ENT_F_IO_V4L; |
| 825 | break; |
| 826 | case VFL_TYPE_VBI: |
| 827 | intf_type = MEDIA_INTF_T_V4L_VBI; |
| 828 | vdev->entity.function = MEDIA_ENT_F_IO_VBI; |
| 829 | break; |
| 830 | case VFL_TYPE_SDR: |
| 831 | intf_type = MEDIA_INTF_T_V4L_SWRADIO; |
| 832 | vdev->entity.function = MEDIA_ENT_F_IO_SWRADIO; |
| 833 | break; |
| 834 | case VFL_TYPE_TOUCH: |
| 835 | intf_type = MEDIA_INTF_T_V4L_TOUCH; |
| 836 | vdev->entity.function = MEDIA_ENT_F_IO_V4L; |
| 837 | break; |
| 838 | case VFL_TYPE_RADIO: |
| 839 | intf_type = MEDIA_INTF_T_V4L_RADIO; |
| 840 | /* |
| 841 | * Radio doesn't have an entity at the V4L2 side to represent |
| 842 | * radio input or output. Instead, the audio input/output goes |
| 843 | * via either physical wires or ALSA. |
| 844 | */ |
| 845 | break; |
| 846 | case VFL_TYPE_SUBDEV: |
| 847 | intf_type = MEDIA_INTF_T_V4L_SUBDEV; |
| 848 | /* Entity will be created via v4l2_device_register_subdev() */ |
| 849 | break; |
| 850 | default: |
| 851 | return 0; |
| 852 | } |
| 853 | |
| 854 | if (vdev->entity.function != MEDIA_ENT_F_UNKNOWN) { |
| 855 | vdev->entity.name = vdev->name; |
| 856 | |
| 857 | /* Needed just for backward compatibility with legacy MC API */ |
| 858 | vdev->entity.info.dev.major = VIDEO_MAJOR; |
| 859 | vdev->entity.info.dev.minor = vdev->minor; |
| 860 | |
| 861 | ret = media_device_register_entity(vdev->v4l2_dev->mdev, |
| 862 | &vdev->entity); |
| 863 | if (ret < 0) { |
| 864 | pr_warn("%s: media_device_register_entity failed\n", |
| 865 | __func__); |
| 866 | return ret; |
| 867 | } |
| 868 | } |
| 869 | |
| 870 | vdev->intf_devnode = media_devnode_create(vdev->v4l2_dev->mdev, |
| 871 | intf_type, |
| 872 | 0, VIDEO_MAJOR, |
| 873 | vdev->minor); |
| 874 | if (!vdev->intf_devnode) { |
| 875 | media_device_unregister_entity(&vdev->entity); |
| 876 | return -ENOMEM; |
| 877 | } |
| 878 | |
| 879 | if (vdev->entity.function != MEDIA_ENT_F_UNKNOWN) { |
| 880 | struct media_link *link; |
| 881 | |
| 882 | link = media_create_intf_link(&vdev->entity, |
| 883 | &vdev->intf_devnode->intf, |
| 884 | MEDIA_LNK_FL_ENABLED | |
| 885 | MEDIA_LNK_FL_IMMUTABLE); |
| 886 | if (!link) { |
| 887 | media_devnode_remove(vdev->intf_devnode); |
| 888 | media_device_unregister_entity(&vdev->entity); |
| 889 | return -ENOMEM; |
| 890 | } |
| 891 | } |
| 892 | |
| 893 | /* FIXME: how to create the other interface links? */ |
| 894 | |
| 895 | #endif |
| 896 | return 0; |
| 897 | } |
| 898 | |
| 899 | int __video_register_device(struct video_device *vdev, |
| 900 | enum vfl_devnode_type type, |
| 901 | int nr, int warn_if_nr_in_use, |
| 902 | struct module *owner) |
| 903 | { |
| 904 | int i = 0; |
| 905 | int ret; |
| 906 | int minor_offset = 0; |
| 907 | int minor_cnt = VIDEO_NUM_DEVICES; |
| 908 | const char *name_base; |
| 909 | |
| 910 | /* A minor value of -1 marks this video device as never |
| 911 | having been registered */ |
| 912 | vdev->minor = -1; |
| 913 | |
| 914 | /* the release callback MUST be present */ |
| 915 | if (WARN_ON(!vdev->release)) |
| 916 | return -EINVAL; |
| 917 | /* the v4l2_dev pointer MUST be present */ |
| 918 | if (WARN_ON(!vdev->v4l2_dev)) |
| 919 | return -EINVAL; |
| 920 | /* the device_caps field MUST be set for all but subdevs */ |
| 921 | if (WARN_ON(type != VFL_TYPE_SUBDEV && !vdev->device_caps)) |
| 922 | return -EINVAL; |
| 923 | |
| 924 | /* v4l2_fh support */ |
| 925 | spin_lock_init(&vdev->fh_lock); |
| 926 | INIT_LIST_HEAD(&vdev->fh_list); |
| 927 | |
| 928 | /* Part 1: check device type */ |
| 929 | switch (type) { |
| 930 | case VFL_TYPE_VIDEO: |
| 931 | name_base = "video"; |
| 932 | break; |
| 933 | case VFL_TYPE_VBI: |
| 934 | name_base = "vbi"; |
| 935 | break; |
| 936 | case VFL_TYPE_RADIO: |
| 937 | name_base = "radio"; |
| 938 | break; |
| 939 | case VFL_TYPE_SUBDEV: |
| 940 | name_base = "v4l-subdev"; |
| 941 | break; |
| 942 | case VFL_TYPE_SDR: |
| 943 | /* Use device name 'swradio' because 'sdr' was already taken. */ |
| 944 | name_base = "swradio"; |
| 945 | break; |
| 946 | case VFL_TYPE_TOUCH: |
| 947 | name_base = "v4l-touch"; |
| 948 | break; |
| 949 | default: |
| 950 | pr_err("%s called with unknown type: %d\n", |
| 951 | __func__, type); |
| 952 | return -EINVAL; |
| 953 | } |
| 954 | |
| 955 | vdev->vfl_type = type; |
| 956 | vdev->cdev = NULL; |
| 957 | if (vdev->dev_parent == NULL) |
| 958 | vdev->dev_parent = vdev->v4l2_dev->dev; |
| 959 | if (vdev->ctrl_handler == NULL) |
| 960 | vdev->ctrl_handler = vdev->v4l2_dev->ctrl_handler; |
| 961 | /* If the prio state pointer is NULL, then use the v4l2_device |
| 962 | prio state. */ |
| 963 | if (vdev->prio == NULL) |
| 964 | vdev->prio = &vdev->v4l2_dev->prio; |
| 965 | |
| 966 | /* Part 2: find a free minor, device node number and device index. */ |
| 967 | #ifdef CONFIG_VIDEO_FIXED_MINOR_RANGES |
| 968 | /* Keep the ranges for the first four types for historical |
| 969 | * reasons. |
| 970 | * Newer devices (not yet in place) should use the range |
| 971 | * of 128-191 and just pick the first free minor there |
| 972 | * (new style). */ |
| 973 | switch (type) { |
| 974 | case VFL_TYPE_VIDEO: |
| 975 | minor_offset = 0; |
| 976 | minor_cnt = 64; |
| 977 | break; |
| 978 | case VFL_TYPE_RADIO: |
| 979 | minor_offset = 64; |
| 980 | minor_cnt = 64; |
| 981 | break; |
| 982 | case VFL_TYPE_VBI: |
| 983 | minor_offset = 224; |
| 984 | minor_cnt = 32; |
| 985 | break; |
| 986 | default: |
| 987 | minor_offset = 128; |
| 988 | minor_cnt = 64; |
| 989 | break; |
| 990 | } |
| 991 | #endif |
| 992 | |
| 993 | /* Pick a device node number */ |
| 994 | mutex_lock(&videodev_lock); |
| 995 | nr = devnode_find(vdev, nr == -1 ? 0 : nr, minor_cnt); |
| 996 | if (nr == minor_cnt) |
| 997 | nr = devnode_find(vdev, 0, minor_cnt); |
| 998 | if (nr == minor_cnt) { |
| 999 | pr_err("could not get a free device node number\n"); |
| 1000 | mutex_unlock(&videodev_lock); |
| 1001 | return -ENFILE; |
| 1002 | } |
| 1003 | #ifdef CONFIG_VIDEO_FIXED_MINOR_RANGES |
| 1004 | /* 1-on-1 mapping of device node number to minor number */ |
| 1005 | i = nr; |
| 1006 | #else |
| 1007 | /* The device node number and minor numbers are independent, so |
| 1008 | we just find the first free minor number. */ |
| 1009 | for (i = 0; i < VIDEO_NUM_DEVICES; i++) |
| 1010 | if (video_devices[i] == NULL) |
| 1011 | break; |
| 1012 | if (i == VIDEO_NUM_DEVICES) { |
| 1013 | mutex_unlock(&videodev_lock); |
| 1014 | pr_err("could not get a free minor\n"); |
| 1015 | return -ENFILE; |
| 1016 | } |
| 1017 | #endif |
| 1018 | vdev->minor = i + minor_offset; |
| 1019 | vdev->num = nr; |
| 1020 | |
| 1021 | /* Should not happen since we thought this minor was free */ |
| 1022 | if (WARN_ON(video_devices[vdev->minor])) { |
| 1023 | mutex_unlock(&videodev_lock); |
| 1024 | pr_err("video_device not empty!\n"); |
| 1025 | return -ENFILE; |
| 1026 | } |
| 1027 | devnode_set(vdev); |
| 1028 | vdev->index = get_index(vdev); |
| 1029 | video_devices[vdev->minor] = vdev; |
| 1030 | mutex_unlock(&videodev_lock); |
| 1031 | |
| 1032 | if (vdev->ioctl_ops) |
| 1033 | determine_valid_ioctls(vdev); |
| 1034 | |
| 1035 | /* Part 3: Initialize the character device */ |
| 1036 | vdev->cdev = cdev_alloc(); |
| 1037 | if (vdev->cdev == NULL) { |
| 1038 | ret = -ENOMEM; |
| 1039 | goto cleanup; |
| 1040 | } |
| 1041 | vdev->cdev->ops = &v4l2_fops; |
| 1042 | vdev->cdev->owner = owner; |
| 1043 | ret = cdev_add(vdev->cdev, MKDEV(VIDEO_MAJOR, vdev->minor), 1); |
| 1044 | if (ret < 0) { |
| 1045 | pr_err("%s: cdev_add failed\n", __func__); |
| 1046 | kfree(vdev->cdev); |
| 1047 | vdev->cdev = NULL; |
| 1048 | goto cleanup; |
| 1049 | } |
| 1050 | |
| 1051 | /* Part 4: register the device with sysfs */ |
| 1052 | vdev->dev.class = &video_class; |
| 1053 | vdev->dev.devt = MKDEV(VIDEO_MAJOR, vdev->minor); |
| 1054 | vdev->dev.parent = vdev->dev_parent; |
| 1055 | dev_set_name(&vdev->dev, "%s%d", name_base, vdev->num); |
| 1056 | mutex_lock(&videodev_lock); |
| 1057 | ret = device_register(&vdev->dev); |
| 1058 | if (ret < 0) { |
| 1059 | mutex_unlock(&videodev_lock); |
| 1060 | pr_err("%s: device_register failed\n", __func__); |
| 1061 | goto cleanup; |
| 1062 | } |
| 1063 | /* Register the release callback that will be called when the last |
| 1064 | reference to the device goes away. */ |
| 1065 | vdev->dev.release = v4l2_device_release; |
| 1066 | |
| 1067 | if (nr != -1 && nr != vdev->num && warn_if_nr_in_use) |
| 1068 | pr_warn("%s: requested %s%d, got %s\n", __func__, |
| 1069 | name_base, nr, video_device_node_name(vdev)); |
| 1070 | |
| 1071 | /* Increase v4l2_device refcount */ |
| 1072 | v4l2_device_get(vdev->v4l2_dev); |
| 1073 | |
| 1074 | /* Part 5: Register the entity. */ |
| 1075 | ret = video_register_media_controller(vdev); |
| 1076 | |
| 1077 | /* Part 6: Activate this minor. The char device can now be used. */ |
| 1078 | set_bit(V4L2_FL_REGISTERED, &vdev->flags); |
| 1079 | mutex_unlock(&videodev_lock); |
| 1080 | |
| 1081 | return 0; |
| 1082 | |
| 1083 | cleanup: |
| 1084 | mutex_lock(&videodev_lock); |
| 1085 | if (vdev->cdev) |
| 1086 | cdev_del(vdev->cdev); |
| 1087 | video_devices[vdev->minor] = NULL; |
| 1088 | devnode_clear(vdev); |
| 1089 | mutex_unlock(&videodev_lock); |
| 1090 | /* Mark this video device as never having been registered. */ |
| 1091 | vdev->minor = -1; |
| 1092 | return ret; |
| 1093 | } |
| 1094 | EXPORT_SYMBOL(__video_register_device); |
| 1095 | |
| 1096 | /** |
| 1097 | * video_unregister_device - unregister a video4linux device |
| 1098 | * @vdev: the device to unregister |
| 1099 | * |
| 1100 | * This unregisters the passed device. Future open calls will |
| 1101 | * be met with errors. |
| 1102 | */ |
| 1103 | void video_unregister_device(struct video_device *vdev) |
| 1104 | { |
| 1105 | /* Check if vdev was ever registered at all */ |
| 1106 | if (!vdev || !video_is_registered(vdev)) |
| 1107 | return; |
| 1108 | |
| 1109 | mutex_lock(&videodev_lock); |
| 1110 | /* This must be in a critical section to prevent a race with v4l2_open. |
| 1111 | * Once this bit has been cleared video_get may never be called again. |
| 1112 | */ |
| 1113 | clear_bit(V4L2_FL_REGISTERED, &vdev->flags); |
| 1114 | mutex_unlock(&videodev_lock); |
| 1115 | if (test_bit(V4L2_FL_USES_V4L2_FH, &vdev->flags)) |
| 1116 | v4l2_event_wake_all(vdev); |
| 1117 | device_unregister(&vdev->dev); |
| 1118 | } |
| 1119 | EXPORT_SYMBOL(video_unregister_device); |
| 1120 | |
| 1121 | #if defined(CONFIG_MEDIA_CONTROLLER) |
| 1122 | |
| 1123 | __must_check int video_device_pipeline_start(struct video_device *vdev, |
| 1124 | struct media_pipeline *pipe) |
| 1125 | { |
| 1126 | struct media_entity *entity = &vdev->entity; |
| 1127 | |
| 1128 | if (entity->num_pads != 1) |
| 1129 | return -ENODEV; |
| 1130 | |
| 1131 | return media_pipeline_start(&entity->pads[0], pipe); |
| 1132 | } |
| 1133 | EXPORT_SYMBOL_GPL(video_device_pipeline_start); |
| 1134 | |
| 1135 | __must_check int __video_device_pipeline_start(struct video_device *vdev, |
| 1136 | struct media_pipeline *pipe) |
| 1137 | { |
| 1138 | struct media_entity *entity = &vdev->entity; |
| 1139 | |
| 1140 | if (entity->num_pads != 1) |
| 1141 | return -ENODEV; |
| 1142 | |
| 1143 | return __media_pipeline_start(&entity->pads[0], pipe); |
| 1144 | } |
| 1145 | EXPORT_SYMBOL_GPL(__video_device_pipeline_start); |
| 1146 | |
| 1147 | void video_device_pipeline_stop(struct video_device *vdev) |
| 1148 | { |
| 1149 | struct media_entity *entity = &vdev->entity; |
| 1150 | |
| 1151 | if (WARN_ON(entity->num_pads != 1)) |
| 1152 | return; |
| 1153 | |
| 1154 | return media_pipeline_stop(&entity->pads[0]); |
| 1155 | } |
| 1156 | EXPORT_SYMBOL_GPL(video_device_pipeline_stop); |
| 1157 | |
| 1158 | void __video_device_pipeline_stop(struct video_device *vdev) |
| 1159 | { |
| 1160 | struct media_entity *entity = &vdev->entity; |
| 1161 | |
| 1162 | if (WARN_ON(entity->num_pads != 1)) |
| 1163 | return; |
| 1164 | |
| 1165 | return __media_pipeline_stop(&entity->pads[0]); |
| 1166 | } |
| 1167 | EXPORT_SYMBOL_GPL(__video_device_pipeline_stop); |
| 1168 | |
| 1169 | __must_check int video_device_pipeline_alloc_start(struct video_device *vdev) |
| 1170 | { |
| 1171 | struct media_entity *entity = &vdev->entity; |
| 1172 | |
| 1173 | if (entity->num_pads != 1) |
| 1174 | return -ENODEV; |
| 1175 | |
| 1176 | return media_pipeline_alloc_start(&entity->pads[0]); |
| 1177 | } |
| 1178 | EXPORT_SYMBOL_GPL(video_device_pipeline_alloc_start); |
| 1179 | |
| 1180 | struct media_pipeline *video_device_pipeline(struct video_device *vdev) |
| 1181 | { |
| 1182 | struct media_entity *entity = &vdev->entity; |
| 1183 | |
| 1184 | if (WARN_ON(entity->num_pads != 1)) |
| 1185 | return NULL; |
| 1186 | |
| 1187 | return media_pad_pipeline(&entity->pads[0]); |
| 1188 | } |
| 1189 | EXPORT_SYMBOL_GPL(video_device_pipeline); |
| 1190 | |
| 1191 | #endif /* CONFIG_MEDIA_CONTROLLER */ |
| 1192 | |
| 1193 | /* |
| 1194 | * Initialise video for linux |
| 1195 | */ |
| 1196 | static int __init videodev_init(void) |
| 1197 | { |
| 1198 | dev_t dev = MKDEV(VIDEO_MAJOR, 0); |
| 1199 | int ret; |
| 1200 | |
| 1201 | pr_info("Linux video capture interface: v2.00\n"); |
| 1202 | ret = register_chrdev_region(dev, VIDEO_NUM_DEVICES, VIDEO_NAME); |
| 1203 | if (ret < 0) { |
| 1204 | pr_warn("videodev: unable to get major %d\n", |
| 1205 | VIDEO_MAJOR); |
| 1206 | return ret; |
| 1207 | } |
| 1208 | |
| 1209 | ret = class_register(&video_class); |
| 1210 | if (ret < 0) { |
| 1211 | unregister_chrdev_region(dev, VIDEO_NUM_DEVICES); |
| 1212 | pr_warn("video_dev: class_register failed\n"); |
| 1213 | return -EIO; |
| 1214 | } |
| 1215 | |
| 1216 | return 0; |
| 1217 | } |
| 1218 | |
| 1219 | static void __exit videodev_exit(void) |
| 1220 | { |
| 1221 | dev_t dev = MKDEV(VIDEO_MAJOR, 0); |
| 1222 | |
| 1223 | class_unregister(&video_class); |
| 1224 | unregister_chrdev_region(dev, VIDEO_NUM_DEVICES); |
| 1225 | } |
| 1226 | |
| 1227 | subsys_initcall(videodev_init); |
| 1228 | module_exit(videodev_exit) |
| 1229 | |
| 1230 | MODULE_AUTHOR("Alan Cox, Mauro Carvalho Chehab <mchehab@kernel.org>, Bill Dirks, Justin Schoeman, Gerd Knorr"); |
| 1231 | MODULE_DESCRIPTION("Video4Linux2 core driver"); |
| 1232 | MODULE_LICENSE("GPL"); |
| 1233 | MODULE_ALIAS_CHARDEV_MAJOR(VIDEO_MAJOR); |