Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 1 | /* |
| 2 | * Video capture interface for Linux version 2 |
| 3 | * |
| 4 | * A generic video device interface for the LINUX operating system |
| 5 | * using a set of device structures/vectors for low level operations. |
| 6 | * |
| 7 | * This program is free software; you can redistribute it and/or |
| 8 | * modify it under the terms of the GNU General Public License |
| 9 | * as published by the Free Software Foundation; either version |
| 10 | * 2 of the License, or (at your option) any later version. |
| 11 | * |
Alan Cox | d9b0144 | 2008-10-27 15:13:47 -0300 | [diff] [blame] | 12 | * Authors: Alan Cox, <alan@lxorguk.ukuu.org.uk> (version 1) |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 13 | * Mauro Carvalho Chehab <mchehab@infradead.org> (version 2) |
| 14 | * |
| 15 | * Fixes: 20000516 Claudio Matsuoka <claudio@conectiva.com> |
| 16 | * - Added procfs support |
| 17 | */ |
| 18 | |
| 19 | #include <linux/module.h> |
| 20 | #include <linux/types.h> |
| 21 | #include <linux/kernel.h> |
| 22 | #include <linux/mm.h> |
| 23 | #include <linux/string.h> |
| 24 | #include <linux/errno.h> |
| 25 | #include <linux/init.h> |
| 26 | #include <linux/kmod.h> |
| 27 | #include <linux/slab.h> |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 28 | #include <asm/uaccess.h> |
| 29 | #include <asm/system.h> |
| 30 | |
| 31 | #include <media/v4l2-common.h> |
Hans Verkuil | 9bea351 | 2008-12-23 07:35:17 -0300 | [diff] [blame] | 32 | #include <media/v4l2-device.h> |
Hans Verkuil | bec4366 | 2008-12-30 06:58:20 -0300 | [diff] [blame] | 33 | #include <media/v4l2-ioctl.h> |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 34 | |
| 35 | #define VIDEO_NUM_DEVICES 256 |
| 36 | #define VIDEO_NAME "video4linux" |
| 37 | |
| 38 | /* |
| 39 | * sysfs stuff |
| 40 | */ |
| 41 | |
| 42 | static ssize_t show_index(struct device *cd, |
| 43 | struct device_attribute *attr, char *buf) |
| 44 | { |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 45 | struct video_device *vdev = to_video_device(cd); |
Hans Verkuil | bfa8a27 | 2008-08-23 07:48:38 -0300 | [diff] [blame] | 46 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 47 | return sprintf(buf, "%i\n", vdev->index); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 48 | } |
| 49 | |
| 50 | static ssize_t show_name(struct device *cd, |
| 51 | struct device_attribute *attr, char *buf) |
| 52 | { |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 53 | struct video_device *vdev = to_video_device(cd); |
Hans Verkuil | bfa8a27 | 2008-08-23 07:48:38 -0300 | [diff] [blame] | 54 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 55 | return sprintf(buf, "%.*s\n", (int)sizeof(vdev->name), vdev->name); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 56 | } |
| 57 | |
| 58 | static struct device_attribute video_device_attrs[] = { |
| 59 | __ATTR(name, S_IRUGO, show_name, NULL), |
| 60 | __ATTR(index, S_IRUGO, show_index, NULL), |
| 61 | __ATTR_NULL |
| 62 | }; |
| 63 | |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 64 | /* |
| 65 | * Active devices |
| 66 | */ |
| 67 | static struct video_device *video_device[VIDEO_NUM_DEVICES]; |
| 68 | static DEFINE_MUTEX(videodev_lock); |
Hans Verkuil | dd89601 | 2008-10-04 08:36:54 -0300 | [diff] [blame] | 69 | static DECLARE_BITMAP(video_nums[VFL_TYPE_MAX], VIDEO_NUM_DEVICES); |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 70 | |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 71 | struct video_device *video_device_alloc(void) |
| 72 | { |
Hans Verkuil | bfa8a27 | 2008-08-23 07:48:38 -0300 | [diff] [blame] | 73 | return kzalloc(sizeof(struct video_device), GFP_KERNEL); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 74 | } |
| 75 | EXPORT_SYMBOL(video_device_alloc); |
| 76 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 77 | void video_device_release(struct video_device *vdev) |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 78 | { |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 79 | kfree(vdev); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 80 | } |
| 81 | EXPORT_SYMBOL(video_device_release); |
| 82 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 83 | void video_device_release_empty(struct video_device *vdev) |
Hans Verkuil | f9e86b5 | 2008-08-23 05:47:41 -0300 | [diff] [blame] | 84 | { |
| 85 | /* Do nothing */ |
| 86 | /* Only valid when the video_device struct is a static. */ |
| 87 | } |
| 88 | EXPORT_SYMBOL(video_device_release_empty); |
| 89 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 90 | static inline void video_get(struct video_device *vdev) |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 91 | { |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 92 | get_device(&vdev->dev); |
| 93 | } |
| 94 | |
| 95 | static inline void video_put(struct video_device *vdev) |
| 96 | { |
| 97 | put_device(&vdev->dev); |
| 98 | } |
| 99 | |
| 100 | /* Called when the last user of the video device exits. */ |
| 101 | static void v4l2_device_release(struct device *cd) |
| 102 | { |
| 103 | struct video_device *vdev = to_video_device(cd); |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 104 | |
| 105 | mutex_lock(&videodev_lock); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 106 | if (video_device[vdev->minor] != vdev) { |
Hans Verkuil | 6ea9a18 | 2008-08-30 09:40:47 -0300 | [diff] [blame] | 107 | mutex_unlock(&videodev_lock); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 108 | /* should not happen */ |
| 109 | WARN_ON(1); |
Hans Verkuil | 6ea9a18 | 2008-08-30 09:40:47 -0300 | [diff] [blame] | 110 | return; |
| 111 | } |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 112 | |
| 113 | /* Free up this device for reuse */ |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 114 | video_device[vdev->minor] = NULL; |
| 115 | |
| 116 | /* Delete the cdev on this minor as well */ |
| 117 | cdev_del(vdev->cdev); |
| 118 | /* Just in case some driver tries to access this from |
| 119 | the release() callback. */ |
| 120 | vdev->cdev = NULL; |
| 121 | |
| 122 | /* Mark minor as free */ |
| 123 | clear_bit(vdev->num, video_nums[vdev->vfl_type]); |
| 124 | |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 125 | mutex_unlock(&videodev_lock); |
| 126 | |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 127 | /* Release video_device and perform other |
| 128 | cleanups as needed. */ |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 129 | vdev->release(vdev); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 130 | } |
| 131 | |
| 132 | static struct class video_class = { |
| 133 | .name = VIDEO_NAME, |
| 134 | .dev_attrs = video_device_attrs, |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 135 | }; |
| 136 | |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 137 | struct video_device *video_devdata(struct file *file) |
| 138 | { |
| 139 | return video_device[iminor(file->f_path.dentry->d_inode)]; |
| 140 | } |
| 141 | EXPORT_SYMBOL(video_devdata); |
| 142 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 143 | static ssize_t v4l2_read(struct file *filp, char __user *buf, |
| 144 | size_t sz, loff_t *off) |
| 145 | { |
| 146 | struct video_device *vdev = video_devdata(filp); |
| 147 | |
| 148 | if (!vdev->fops->read) |
| 149 | return -EINVAL; |
| 150 | if (video_is_unregistered(vdev)) |
| 151 | return -EIO; |
| 152 | return vdev->fops->read(filp, buf, sz, off); |
| 153 | } |
| 154 | |
| 155 | static ssize_t v4l2_write(struct file *filp, const char __user *buf, |
| 156 | size_t sz, loff_t *off) |
| 157 | { |
| 158 | struct video_device *vdev = video_devdata(filp); |
| 159 | |
| 160 | if (!vdev->fops->write) |
| 161 | return -EINVAL; |
| 162 | if (video_is_unregistered(vdev)) |
| 163 | return -EIO; |
| 164 | return vdev->fops->write(filp, buf, sz, off); |
| 165 | } |
| 166 | |
| 167 | static unsigned int v4l2_poll(struct file *filp, struct poll_table_struct *poll) |
| 168 | { |
| 169 | struct video_device *vdev = video_devdata(filp); |
| 170 | |
| 171 | if (!vdev->fops->poll || video_is_unregistered(vdev)) |
| 172 | return DEFAULT_POLLMASK; |
| 173 | return vdev->fops->poll(filp, poll); |
| 174 | } |
| 175 | |
| 176 | static int v4l2_ioctl(struct inode *inode, struct file *filp, |
| 177 | unsigned int cmd, unsigned long arg) |
| 178 | { |
| 179 | struct video_device *vdev = video_devdata(filp); |
| 180 | |
| 181 | if (!vdev->fops->ioctl) |
| 182 | return -ENOTTY; |
| 183 | /* Allow ioctl to continue even if the device was unregistered. |
| 184 | Things like dequeueing buffers might still be useful. */ |
Hans Verkuil | bec4366 | 2008-12-30 06:58:20 -0300 | [diff] [blame] | 185 | return vdev->fops->ioctl(filp, cmd, arg); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 186 | } |
| 187 | |
| 188 | static long v4l2_unlocked_ioctl(struct file *filp, |
| 189 | unsigned int cmd, unsigned long arg) |
| 190 | { |
| 191 | struct video_device *vdev = video_devdata(filp); |
| 192 | |
| 193 | if (!vdev->fops->unlocked_ioctl) |
| 194 | return -ENOTTY; |
| 195 | /* Allow ioctl to continue even if the device was unregistered. |
| 196 | Things like dequeueing buffers might still be useful. */ |
| 197 | return vdev->fops->unlocked_ioctl(filp, cmd, arg); |
| 198 | } |
| 199 | |
Daniel Glöckner | c01f1a5 | 2009-03-26 11:31:08 -0300 | [diff] [blame] | 200 | #ifdef CONFIG_MMU |
| 201 | #define v4l2_get_unmapped_area NULL |
| 202 | #else |
| 203 | static unsigned long v4l2_get_unmapped_area(struct file *filp, |
| 204 | unsigned long addr, unsigned long len, unsigned long pgoff, |
| 205 | unsigned long flags) |
| 206 | { |
| 207 | struct video_device *vdev = video_devdata(filp); |
| 208 | |
| 209 | if (!vdev->fops->get_unmapped_area) |
| 210 | return -ENOSYS; |
| 211 | if (video_is_unregistered(vdev)) |
| 212 | return -ENODEV; |
| 213 | return vdev->fops->get_unmapped_area(filp, addr, len, pgoff, flags); |
| 214 | } |
| 215 | #endif |
| 216 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 217 | static int v4l2_mmap(struct file *filp, struct vm_area_struct *vm) |
| 218 | { |
| 219 | struct video_device *vdev = video_devdata(filp); |
| 220 | |
| 221 | if (!vdev->fops->mmap || |
| 222 | video_is_unregistered(vdev)) |
| 223 | return -ENODEV; |
| 224 | return vdev->fops->mmap(filp, vm); |
| 225 | } |
| 226 | |
| 227 | /* Override for the open function */ |
| 228 | static int v4l2_open(struct inode *inode, struct file *filp) |
| 229 | { |
| 230 | struct video_device *vdev; |
Hans Verkuil | 65d9ff9 | 2009-03-29 20:19:38 -0300 | [diff] [blame] | 231 | int ret = 0; |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 232 | |
| 233 | /* Check if the video device is available */ |
| 234 | mutex_lock(&videodev_lock); |
| 235 | vdev = video_devdata(filp); |
| 236 | /* return ENODEV if the video device has been removed |
| 237 | already or if it is not registered anymore. */ |
| 238 | if (vdev == NULL || video_is_unregistered(vdev)) { |
| 239 | mutex_unlock(&videodev_lock); |
| 240 | return -ENODEV; |
| 241 | } |
| 242 | /* and increase the device refcount */ |
| 243 | video_get(vdev); |
| 244 | mutex_unlock(&videodev_lock); |
Hans Verkuil | 65d9ff9 | 2009-03-29 20:19:38 -0300 | [diff] [blame] | 245 | if (vdev->fops->open) |
| 246 | ret = vdev->fops->open(filp); |
| 247 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 248 | /* decrease the refcount in case of an error */ |
| 249 | if (ret) |
| 250 | video_put(vdev); |
| 251 | return ret; |
| 252 | } |
| 253 | |
| 254 | /* Override for the release function */ |
| 255 | static int v4l2_release(struct inode *inode, struct file *filp) |
| 256 | { |
| 257 | struct video_device *vdev = video_devdata(filp); |
Hans Verkuil | 65d9ff9 | 2009-03-29 20:19:38 -0300 | [diff] [blame] | 258 | int ret = 0; |
| 259 | |
| 260 | if (vdev->fops->release) |
| 261 | vdev->fops->release(filp); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 262 | |
| 263 | /* decrease the refcount unconditionally since the release() |
| 264 | return value is ignored. */ |
| 265 | video_put(vdev); |
| 266 | return ret; |
| 267 | } |
| 268 | |
| 269 | static const struct file_operations v4l2_unlocked_fops = { |
| 270 | .owner = THIS_MODULE, |
| 271 | .read = v4l2_read, |
| 272 | .write = v4l2_write, |
| 273 | .open = v4l2_open, |
Daniel Glöckner | c01f1a5 | 2009-03-26 11:31:08 -0300 | [diff] [blame] | 274 | .get_unmapped_area = v4l2_get_unmapped_area, |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 275 | .mmap = v4l2_mmap, |
| 276 | .unlocked_ioctl = v4l2_unlocked_ioctl, |
| 277 | #ifdef CONFIG_COMPAT |
Hans Verkuil | 9bb7cde | 2008-12-30 06:42:40 -0300 | [diff] [blame] | 278 | .compat_ioctl = v4l2_compat_ioctl32, |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 279 | #endif |
| 280 | .release = v4l2_release, |
| 281 | .poll = v4l2_poll, |
| 282 | .llseek = no_llseek, |
| 283 | }; |
| 284 | |
| 285 | static const struct file_operations v4l2_fops = { |
| 286 | .owner = THIS_MODULE, |
| 287 | .read = v4l2_read, |
| 288 | .write = v4l2_write, |
| 289 | .open = v4l2_open, |
Daniel Glöckner | c01f1a5 | 2009-03-26 11:31:08 -0300 | [diff] [blame] | 290 | .get_unmapped_area = v4l2_get_unmapped_area, |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 291 | .mmap = v4l2_mmap, |
| 292 | .ioctl = v4l2_ioctl, |
| 293 | #ifdef CONFIG_COMPAT |
Hans Verkuil | 9bb7cde | 2008-12-30 06:42:40 -0300 | [diff] [blame] | 294 | .compat_ioctl = v4l2_compat_ioctl32, |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 295 | #endif |
| 296 | .release = v4l2_release, |
| 297 | .poll = v4l2_poll, |
| 298 | .llseek = no_llseek, |
| 299 | }; |
| 300 | |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 301 | /** |
| 302 | * get_index - assign stream number based on parent device |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 303 | * @vdev: video_device to assign index number to, vdev->parent should be assigned |
| 304 | * @num: -1 if auto assign, requested number otherwise |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 305 | * |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 306 | * Note that when this is called the new device has not yet been registered |
| 307 | * in the video_device array. |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 308 | * |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 309 | * Returns -ENFILE if num is already in use, a free index number if |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 310 | * successful. |
| 311 | */ |
| 312 | static int get_index(struct video_device *vdev, int num) |
| 313 | { |
Hans Verkuil | 775a05d | 2009-02-14 11:31:01 -0300 | [diff] [blame] | 314 | /* This can be static since this function is called with the global |
| 315 | videodev_lock held. */ |
| 316 | static DECLARE_BITMAP(used, VIDEO_NUM_DEVICES); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 317 | int i; |
| 318 | |
Hans Verkuil | 775a05d | 2009-02-14 11:31:01 -0300 | [diff] [blame] | 319 | if (num >= VIDEO_NUM_DEVICES) { |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 320 | printk(KERN_ERR "videodev: %s num is too large\n", __func__); |
| 321 | return -EINVAL; |
| 322 | } |
| 323 | |
Hans Verkuil | 775a05d | 2009-02-14 11:31:01 -0300 | [diff] [blame] | 324 | /* Some drivers do not set the parent. In that case always return |
| 325 | num or 0. */ |
Hans Verkuil | 806e5b7 | 2008-12-19 09:10:56 -0300 | [diff] [blame] | 326 | if (vdev->parent == NULL) |
Hans Verkuil | 775a05d | 2009-02-14 11:31:01 -0300 | [diff] [blame] | 327 | return num >= 0 ? num : 0; |
| 328 | |
| 329 | bitmap_zero(used, VIDEO_NUM_DEVICES); |
Hans Verkuil | 806e5b7 | 2008-12-19 09:10:56 -0300 | [diff] [blame] | 330 | |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 331 | for (i = 0; i < VIDEO_NUM_DEVICES; i++) { |
| 332 | if (video_device[i] != NULL && |
Hans Verkuil | 5e85e73 | 2008-07-20 06:31:39 -0300 | [diff] [blame] | 333 | video_device[i]->parent == vdev->parent) { |
Hans Verkuil | 775a05d | 2009-02-14 11:31:01 -0300 | [diff] [blame] | 334 | set_bit(video_device[i]->index, used); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 335 | } |
| 336 | } |
| 337 | |
| 338 | if (num >= 0) { |
Hans Verkuil | 775a05d | 2009-02-14 11:31:01 -0300 | [diff] [blame] | 339 | if (test_bit(num, used)) |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 340 | return -ENFILE; |
| 341 | return num; |
| 342 | } |
| 343 | |
Hans Verkuil | 775a05d | 2009-02-14 11:31:01 -0300 | [diff] [blame] | 344 | i = find_first_zero_bit(used, VIDEO_NUM_DEVICES); |
| 345 | return i == VIDEO_NUM_DEVICES ? -ENFILE : i; |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 346 | } |
| 347 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 348 | int video_register_device(struct video_device *vdev, int type, int nr) |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 349 | { |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 350 | return video_register_device_index(vdev, type, nr, -1); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 351 | } |
| 352 | EXPORT_SYMBOL(video_register_device); |
| 353 | |
| 354 | /** |
Randy Dunlap | edc9189 | 2008-07-28 15:39:38 -0300 | [diff] [blame] | 355 | * video_register_device_index - register video4linux devices |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 356 | * @vdev: video device structure we want to register |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 357 | * @type: type of device to register |
| 358 | * @nr: which device number (0 == /dev/video0, 1 == /dev/video1, ... |
| 359 | * -1 == first free) |
Randy Dunlap | edc9189 | 2008-07-28 15:39:38 -0300 | [diff] [blame] | 360 | * @index: stream number based on parent device; |
| 361 | * -1 if auto assign, requested number otherwise |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 362 | * |
| 363 | * The registration code assigns minor numbers based on the type |
| 364 | * requested. -ENFILE is returned in all the device slots for this |
| 365 | * category are full. If not then the minor field is set and the |
| 366 | * driver initialize function is called (if non %NULL). |
| 367 | * |
| 368 | * Zero is returned on success. |
| 369 | * |
| 370 | * Valid types are |
| 371 | * |
| 372 | * %VFL_TYPE_GRABBER - A frame grabber |
| 373 | * |
| 374 | * %VFL_TYPE_VTX - A teletext device |
| 375 | * |
| 376 | * %VFL_TYPE_VBI - Vertical blank data (undecoded) |
| 377 | * |
| 378 | * %VFL_TYPE_RADIO - A radio card |
| 379 | */ |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 380 | int video_register_device_index(struct video_device *vdev, int type, int nr, |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 381 | int index) |
| 382 | { |
| 383 | int i = 0; |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 384 | int ret; |
Hans Verkuil | dd89601 | 2008-10-04 08:36:54 -0300 | [diff] [blame] | 385 | int minor_offset = 0; |
| 386 | int minor_cnt = VIDEO_NUM_DEVICES; |
| 387 | const char *name_base; |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 388 | void *priv = video_get_drvdata(vdev); |
| 389 | |
| 390 | /* A minor value of -1 marks this video device as never |
| 391 | having been registered */ |
Trent Piepho | 428c8d1 | 2009-03-03 18:51:52 -0300 | [diff] [blame] | 392 | vdev->minor = -1; |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 393 | |
Hans Verkuil | d6e7497 | 2008-08-23 06:27:59 -0300 | [diff] [blame] | 394 | /* the release callback MUST be present */ |
Trent Piepho | 428c8d1 | 2009-03-03 18:51:52 -0300 | [diff] [blame] | 395 | WARN_ON(!vdev->release); |
| 396 | if (!vdev->release) |
Henrik Kretzschmar | ee7aa9f | 2008-08-22 16:41:03 -0300 | [diff] [blame] | 397 | return -EINVAL; |
| 398 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 399 | /* Part 1: check device type */ |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 400 | switch (type) { |
| 401 | case VFL_TYPE_GRABBER: |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 402 | name_base = "video"; |
| 403 | break; |
| 404 | case VFL_TYPE_VTX: |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 405 | name_base = "vtx"; |
| 406 | break; |
| 407 | case VFL_TYPE_VBI: |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 408 | name_base = "vbi"; |
| 409 | break; |
| 410 | case VFL_TYPE_RADIO: |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 411 | name_base = "radio"; |
| 412 | break; |
| 413 | default: |
| 414 | printk(KERN_ERR "%s called with unknown type: %d\n", |
| 415 | __func__, type); |
Henrik Kretzschmar | 46f2c21 | 2008-09-03 16:47:39 -0300 | [diff] [blame] | 416 | return -EINVAL; |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 417 | } |
| 418 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 419 | vdev->vfl_type = type; |
| 420 | vdev->cdev = NULL; |
Hans Verkuil | 0057596 | 2009-03-13 10:03:04 -0300 | [diff] [blame] | 421 | if (vdev->v4l2_dev && vdev->v4l2_dev->dev) |
Hans Verkuil | 9bea351 | 2008-12-23 07:35:17 -0300 | [diff] [blame] | 422 | vdev->parent = vdev->v4l2_dev->dev; |
Hans Verkuil | dd89601 | 2008-10-04 08:36:54 -0300 | [diff] [blame] | 423 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 424 | /* Part 2: find a free minor, kernel number and device index. */ |
Hans Verkuil | dd89601 | 2008-10-04 08:36:54 -0300 | [diff] [blame] | 425 | #ifdef CONFIG_VIDEO_FIXED_MINOR_RANGES |
| 426 | /* Keep the ranges for the first four types for historical |
| 427 | * reasons. |
| 428 | * Newer devices (not yet in place) should use the range |
| 429 | * of 128-191 and just pick the first free minor there |
| 430 | * (new style). */ |
| 431 | switch (type) { |
| 432 | case VFL_TYPE_GRABBER: |
| 433 | minor_offset = 0; |
| 434 | minor_cnt = 64; |
| 435 | break; |
| 436 | case VFL_TYPE_RADIO: |
| 437 | minor_offset = 64; |
| 438 | minor_cnt = 64; |
| 439 | break; |
| 440 | case VFL_TYPE_VTX: |
| 441 | minor_offset = 192; |
| 442 | minor_cnt = 32; |
| 443 | break; |
| 444 | case VFL_TYPE_VBI: |
| 445 | minor_offset = 224; |
| 446 | minor_cnt = 32; |
| 447 | break; |
| 448 | default: |
| 449 | minor_offset = 128; |
| 450 | minor_cnt = 64; |
| 451 | break; |
| 452 | } |
| 453 | #endif |
| 454 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 455 | /* Pick a minor number */ |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 456 | mutex_lock(&videodev_lock); |
Hans Verkuil | dd89601 | 2008-10-04 08:36:54 -0300 | [diff] [blame] | 457 | nr = find_next_zero_bit(video_nums[type], minor_cnt, nr == -1 ? 0 : nr); |
| 458 | if (nr == minor_cnt) |
| 459 | nr = find_first_zero_bit(video_nums[type], minor_cnt); |
| 460 | if (nr == minor_cnt) { |
| 461 | printk(KERN_ERR "could not get a free kernel number\n"); |
| 462 | mutex_unlock(&videodev_lock); |
| 463 | return -ENFILE; |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 464 | } |
Hans Verkuil | dd89601 | 2008-10-04 08:36:54 -0300 | [diff] [blame] | 465 | #ifdef CONFIG_VIDEO_FIXED_MINOR_RANGES |
| 466 | /* 1-on-1 mapping of kernel number to minor number */ |
| 467 | i = nr; |
| 468 | #else |
| 469 | /* The kernel number and minor numbers are independent */ |
| 470 | for (i = 0; i < VIDEO_NUM_DEVICES; i++) |
| 471 | if (video_device[i] == NULL) |
| 472 | break; |
| 473 | if (i == VIDEO_NUM_DEVICES) { |
| 474 | mutex_unlock(&videodev_lock); |
| 475 | printk(KERN_ERR "could not get a free minor\n"); |
| 476 | return -ENFILE; |
| 477 | } |
| 478 | #endif |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 479 | vdev->minor = i + minor_offset; |
| 480 | vdev->num = nr; |
Hans Verkuil | dd89601 | 2008-10-04 08:36:54 -0300 | [diff] [blame] | 481 | set_bit(nr, video_nums[type]); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 482 | /* Should not happen since we thought this minor was free */ |
| 483 | WARN_ON(video_device[vdev->minor] != NULL); |
| 484 | ret = vdev->index = get_index(vdev, index); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 485 | mutex_unlock(&videodev_lock); |
| 486 | |
| 487 | if (ret < 0) { |
| 488 | printk(KERN_ERR "%s: get_index failed\n", __func__); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 489 | goto cleanup; |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 490 | } |
| 491 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 492 | /* Part 3: Initialize the character device */ |
| 493 | vdev->cdev = cdev_alloc(); |
| 494 | if (vdev->cdev == NULL) { |
| 495 | ret = -ENOMEM; |
| 496 | goto cleanup; |
| 497 | } |
| 498 | if (vdev->fops->unlocked_ioctl) |
| 499 | vdev->cdev->ops = &v4l2_unlocked_fops; |
| 500 | else |
| 501 | vdev->cdev->ops = &v4l2_fops; |
| 502 | vdev->cdev->owner = vdev->fops->owner; |
| 503 | ret = cdev_add(vdev->cdev, MKDEV(VIDEO_MAJOR, vdev->minor), 1); |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 504 | if (ret < 0) { |
| 505 | printk(KERN_ERR "%s: cdev_add failed\n", __func__); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 506 | kfree(vdev->cdev); |
| 507 | vdev->cdev = NULL; |
| 508 | goto cleanup; |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 509 | } |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 510 | |
| 511 | /* Part 4: register the device with sysfs */ |
| 512 | memset(&vdev->dev, 0, sizeof(vdev->dev)); |
Hans Verkuil | 9d95af9 | 2008-08-24 11:18:47 -0300 | [diff] [blame] | 513 | /* The memset above cleared the device's drvdata, so |
| 514 | put back the copy we made earlier. */ |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 515 | video_set_drvdata(vdev, priv); |
| 516 | vdev->dev.class = &video_class; |
| 517 | vdev->dev.devt = MKDEV(VIDEO_MAJOR, vdev->minor); |
| 518 | if (vdev->parent) |
| 519 | vdev->dev.parent = vdev->parent; |
| 520 | dev_set_name(&vdev->dev, "%s%d", name_base, nr); |
| 521 | ret = device_register(&vdev->dev); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 522 | if (ret < 0) { |
| 523 | printk(KERN_ERR "%s: device_register failed\n", __func__); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 524 | goto cleanup; |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 525 | } |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 526 | /* Register the release callback that will be called when the last |
| 527 | reference to the device goes away. */ |
| 528 | vdev->dev.release = v4l2_device_release; |
| 529 | |
| 530 | /* Part 5: Activate this minor. The char device can now be used. */ |
| 531 | mutex_lock(&videodev_lock); |
| 532 | video_device[vdev->minor] = vdev; |
| 533 | mutex_unlock(&videodev_lock); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 534 | return 0; |
| 535 | |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 536 | cleanup: |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 537 | mutex_lock(&videodev_lock); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 538 | if (vdev->cdev) |
| 539 | cdev_del(vdev->cdev); |
| 540 | clear_bit(vdev->num, video_nums[type]); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 541 | mutex_unlock(&videodev_lock); |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 542 | /* Mark this video device as never having been registered. */ |
| 543 | vdev->minor = -1; |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 544 | return ret; |
| 545 | } |
| 546 | EXPORT_SYMBOL(video_register_device_index); |
| 547 | |
| 548 | /** |
| 549 | * video_unregister_device - unregister a video4linux device |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 550 | * @vdev: the device to unregister |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 551 | * |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 552 | * This unregisters the passed device. Future open calls will |
| 553 | * be met with errors. |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 554 | */ |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 555 | void video_unregister_device(struct video_device *vdev) |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 556 | { |
Hans Verkuil | dc93a70 | 2008-12-19 21:28:27 -0300 | [diff] [blame] | 557 | /* Check if vdev was ever registered at all */ |
| 558 | if (!vdev || vdev->minor < 0) |
| 559 | return; |
| 560 | |
| 561 | mutex_lock(&videodev_lock); |
| 562 | set_bit(V4L2_FL_UNREGISTERED, &vdev->flags); |
| 563 | mutex_unlock(&videodev_lock); |
| 564 | device_unregister(&vdev->dev); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 565 | } |
| 566 | EXPORT_SYMBOL(video_unregister_device); |
| 567 | |
| 568 | /* |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 569 | * Initialise video for linux |
| 570 | */ |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 571 | static int __init videodev_init(void) |
| 572 | { |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 573 | dev_t dev = MKDEV(VIDEO_MAJOR, 0); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 574 | int ret; |
| 575 | |
| 576 | printk(KERN_INFO "Linux video capture interface: v2.00\n"); |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 577 | ret = register_chrdev_region(dev, VIDEO_NUM_DEVICES, VIDEO_NAME); |
| 578 | if (ret < 0) { |
| 579 | printk(KERN_WARNING "videodev: unable to get major %d\n", |
| 580 | VIDEO_MAJOR); |
| 581 | return ret; |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 582 | } |
| 583 | |
| 584 | ret = class_register(&video_class); |
| 585 | if (ret < 0) { |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 586 | unregister_chrdev_region(dev, VIDEO_NUM_DEVICES); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 587 | printk(KERN_WARNING "video_dev: class_register failed\n"); |
| 588 | return -EIO; |
| 589 | } |
| 590 | |
| 591 | return 0; |
| 592 | } |
| 593 | |
| 594 | static void __exit videodev_exit(void) |
| 595 | { |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 596 | dev_t dev = MKDEV(VIDEO_MAJOR, 0); |
| 597 | |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 598 | class_unregister(&video_class); |
Hans Verkuil | 7f8ecfa | 2008-08-29 17:31:35 -0300 | [diff] [blame] | 599 | unregister_chrdev_region(dev, VIDEO_NUM_DEVICES); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 600 | } |
| 601 | |
| 602 | module_init(videodev_init) |
| 603 | module_exit(videodev_exit) |
| 604 | |
| 605 | MODULE_AUTHOR("Alan Cox, Mauro Carvalho Chehab <mchehab@infradead.org>"); |
| 606 | MODULE_DESCRIPTION("Device registrar for Video4Linux drivers v2"); |
| 607 | MODULE_LICENSE("GPL"); |
Scott James Remnant | cbb72b0 | 2009-03-02 15:40:57 -0300 | [diff] [blame] | 608 | MODULE_ALIAS_CHARDEV_MAJOR(VIDEO_MAJOR); |
Hans Verkuil | 27a5e6d | 2008-07-20 08:43:17 -0300 | [diff] [blame] | 609 | |
| 610 | |
| 611 | /* |
| 612 | * Local variables: |
| 613 | * c-basic-offset: 8 |
| 614 | * End: |
| 615 | */ |