1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <linux/types.h>
25#include <linux/errno.h>
26#include <linux/string.h>
27#include <linux/module.h>
28#include <linux/kernel.h>
29#include <linux/init.h>
30#include <linux/slab.h>
31#include <linux/device.h>
32#include <linux/fs.h>
33#include <linux/cdev.h>
34#include <linux/mutex.h>
35#include "dvbdev.h"
36
37static DEFINE_MUTEX(dvbdev_mutex);
38static int dvbdev_debug;
39
40module_param(dvbdev_debug, int, 0644);
41MODULE_PARM_DESC(dvbdev_debug, "Turn on/off device debugging (default:off).");
42
43#define dprintk if (dvbdev_debug) printk
44
45static LIST_HEAD(dvb_adapter_list);
46static DEFINE_MUTEX(dvbdev_register_lock);
47
48static const char * const dnames[] = {
49 "video", "audio", "sec", "frontend", "demux", "dvr", "ca",
50 "net", "osd"
51};
52
53#ifdef CONFIG_DVB_DYNAMIC_MINORS
54#define MAX_DVB_MINORS 256
55#define DVB_MAX_IDS MAX_DVB_MINORS
56#else
57#define DVB_MAX_IDS 4
58#define nums2minor(num,type,id) ((num << 6) | (id << 4) | type)
59#define MAX_DVB_MINORS (DVB_MAX_ADAPTERS*64)
60#endif
61
62static struct class *dvb_class;
63
64static struct dvb_device *dvb_minors[MAX_DVB_MINORS];
65static DECLARE_RWSEM(minor_rwsem);
66
67static int dvb_device_open(struct inode *inode, struct file *file)
68{
69 struct dvb_device *dvbdev;
70
71 mutex_lock(&dvbdev_mutex);
72 down_read(&minor_rwsem);
73 dvbdev = dvb_minors[iminor(inode)];
74
75 if (dvbdev && dvbdev->fops) {
76 int err = 0;
77 const struct file_operations *old_fops;
78
79 file->private_data = dvbdev;
80 old_fops = file->f_op;
81 file->f_op = fops_get(dvbdev->fops);
82 if (file->f_op == NULL) {
83 file->f_op = old_fops;
84 goto fail;
85 }
86 if(file->f_op->open)
87 err = file->f_op->open(inode,file);
88 if (err) {
89 fops_put(file->f_op);
90 file->f_op = fops_get(old_fops);
91 }
92 fops_put(old_fops);
93 up_read(&minor_rwsem);
94 mutex_unlock(&dvbdev_mutex);
95 return err;
96 }
97fail:
98 up_read(&minor_rwsem);
99 mutex_unlock(&dvbdev_mutex);
100 return -ENODEV;
101}
102
103
104static const struct file_operations dvb_device_fops =
105{
106 .owner = THIS_MODULE,
107 .open = dvb_device_open,
108 .llseek = noop_llseek,
109};
110
111static struct cdev dvb_device_cdev;
112
113int dvb_generic_open(struct inode *inode, struct file *file)
114{
115 struct dvb_device *dvbdev = file->private_data;
116
117 if (!dvbdev)
118 return -ENODEV;
119
120 if (!dvbdev->users)
121 return -EBUSY;
122
123 if ((file->f_flags & O_ACCMODE) == O_RDONLY) {
124 if (!dvbdev->readers)
125 return -EBUSY;
126 dvbdev->readers--;
127 } else {
128 if (!dvbdev->writers)
129 return -EBUSY;
130 dvbdev->writers--;
131 }
132
133 dvbdev->users--;
134 return 0;
135}
136EXPORT_SYMBOL(dvb_generic_open);
137
138
139int dvb_generic_release(struct inode *inode, struct file *file)
140{
141 struct dvb_device *dvbdev = file->private_data;
142
143 if (!dvbdev)
144 return -ENODEV;
145
146 if ((file->f_flags & O_ACCMODE) == O_RDONLY) {
147 dvbdev->readers++;
148 } else {
149 dvbdev->writers++;
150 }
151
152 dvbdev->users++;
153 return 0;
154}
155EXPORT_SYMBOL(dvb_generic_release);
156
157
158long dvb_generic_ioctl(struct file *file,
159 unsigned int cmd, unsigned long arg)
160{
161 struct dvb_device *dvbdev = file->private_data;
162
163 if (!dvbdev)
164 return -ENODEV;
165
166 if (!dvbdev->kernel_ioctl)
167 return -EINVAL;
168
169 return dvb_usercopy(file, cmd, arg, dvbdev->kernel_ioctl);
170}
171EXPORT_SYMBOL(dvb_generic_ioctl);
172
173
174static int dvbdev_get_free_id (struct dvb_adapter *adap, int type)
175{
176 u32 id = 0;
177
178 while (id < DVB_MAX_IDS) {
179 struct dvb_device *dev;
180 list_for_each_entry(dev, &adap->device_list, list_head)
181 if (dev->type == type && dev->id == id)
182 goto skip;
183 return id;
184skip:
185 id++;
186 }
187 return -ENFILE;
188}
189
190
191int dvb_register_device(struct dvb_adapter *adap, struct dvb_device **pdvbdev,
192 const struct dvb_device *template, void *priv, int type)
193{
194 struct dvb_device *dvbdev;
195 struct file_operations *dvbdevfops;
196 struct device *clsdev;
197 int minor;
198 int id;
199
200 mutex_lock(&dvbdev_register_lock);
201
202 if ((id = dvbdev_get_free_id (adap, type)) < 0){
203 mutex_unlock(&dvbdev_register_lock);
204 *pdvbdev = NULL;
205 printk(KERN_ERR "%s: couldn't find free device id\n", __func__);
206 return -ENFILE;
207 }
208
209 *pdvbdev = dvbdev = kmalloc(sizeof(struct dvb_device), GFP_KERNEL);
210
211 if (!dvbdev){
212 mutex_unlock(&dvbdev_register_lock);
213 return -ENOMEM;
214 }
215
216 dvbdevfops = kzalloc(sizeof(struct file_operations), GFP_KERNEL);
217
218 if (!dvbdevfops){
219 kfree (dvbdev);
220 mutex_unlock(&dvbdev_register_lock);
221 return -ENOMEM;
222 }
223
224 memcpy(dvbdev, template, sizeof(struct dvb_device));
225 dvbdev->type = type;
226 dvbdev->id = id;
227 dvbdev->adapter = adap;
228 dvbdev->priv = priv;
229 dvbdev->fops = dvbdevfops;
230 init_waitqueue_head (&dvbdev->wait_queue);
231
232 memcpy(dvbdevfops, template->fops, sizeof(struct file_operations));
233 dvbdevfops->owner = adap->module;
234
235 list_add_tail (&dvbdev->list_head, &adap->device_list);
236
237 down_write(&minor_rwsem);
238#ifdef CONFIG_DVB_DYNAMIC_MINORS
239 for (minor = 0; minor < MAX_DVB_MINORS; minor++)
240 if (dvb_minors[minor] == NULL)
241 break;
242
243 if (minor == MAX_DVB_MINORS) {
244 kfree(dvbdevfops);
245 kfree(dvbdev);
246 mutex_unlock(&dvbdev_register_lock);
247 return -EINVAL;
248 }
249#else
250 minor = nums2minor(adap->num, type, id);
251#endif
252
253 dvbdev->minor = minor;
254 dvb_minors[minor] = dvbdev;
255 up_write(&minor_rwsem);
256
257 mutex_unlock(&dvbdev_register_lock);
258
259 clsdev = device_create(dvb_class, adap->device,
260 MKDEV(DVB_MAJOR, minor),
261 dvbdev, "dvb%d.%s%d", adap->num, dnames[type], id);
262 if (IS_ERR(clsdev)) {
263 printk(KERN_ERR "%s: failed to create device dvb%d.%s%d (%ld)\n",
264 __func__, adap->num, dnames[type], id, PTR_ERR(clsdev));
265 return PTR_ERR(clsdev);
266 }
267
268 dprintk(KERN_DEBUG "DVB: register adapter%d/%s%d @ minor: %i (0x%02x)\n",
269 adap->num, dnames[type], id, minor, minor);
270
271 return 0;
272}
273EXPORT_SYMBOL(dvb_register_device);
274
275
276void dvb_unregister_device(struct dvb_device *dvbdev)
277{
278 if (!dvbdev)
279 return;
280
281 down_write(&minor_rwsem);
282 dvb_minors[dvbdev->minor] = NULL;
283 up_write(&minor_rwsem);
284
285 device_destroy(dvb_class, MKDEV(DVB_MAJOR, dvbdev->minor));
286
287 list_del (&dvbdev->list_head);
288 kfree (dvbdev->fops);
289 kfree (dvbdev);
290}
291EXPORT_SYMBOL(dvb_unregister_device);
292
293static int dvbdev_check_free_adapter_num(int num)
294{
295 struct list_head *entry;
296 list_for_each(entry, &dvb_adapter_list) {
297 struct dvb_adapter *adap;
298 adap = list_entry(entry, struct dvb_adapter, list_head);
299 if (adap->num == num)
300 return 0;
301 }
302 return 1;
303}
304
305static int dvbdev_get_free_adapter_num (void)
306{
307 int num = 0;
308
309 while (num < DVB_MAX_ADAPTERS) {
310 if (dvbdev_check_free_adapter_num(num))
311 return num;
312 num++;
313 }
314
315 return -ENFILE;
316}
317
318
319int dvb_register_adapter(struct dvb_adapter *adap, const char *name,
320 struct module *module, struct device *device,
321 short *adapter_nums)
322{
323 int i, num;
324
325 mutex_lock(&dvbdev_register_lock);
326
327 for (i = 0; i < DVB_MAX_ADAPTERS; ++i) {
328 num = adapter_nums[i];
329 if (num >= 0 && num < DVB_MAX_ADAPTERS) {
330
331 if (dvbdev_check_free_adapter_num(num))
332 break;
333 } else {
334 num = dvbdev_get_free_adapter_num();
335 break;
336 }
337 num = -1;
338 }
339
340 if (num < 0) {
341 mutex_unlock(&dvbdev_register_lock);
342 return -ENFILE;
343 }
344
345 memset (adap, 0, sizeof(struct dvb_adapter));
346 INIT_LIST_HEAD (&adap->device_list);
347
348 printk(KERN_INFO "DVB: registering new adapter (%s)\n", name);
349
350 adap->num = num;
351 adap->name = name;
352 adap->module = module;
353 adap->device = device;
354 adap->mfe_shared = 0;
355 adap->mfe_dvbdev = NULL;
356 mutex_init (&adap->mfe_lock);
357
358 list_add_tail (&adap->list_head, &dvb_adapter_list);
359
360 mutex_unlock(&dvbdev_register_lock);
361
362 return num;
363}
364EXPORT_SYMBOL(dvb_register_adapter);
365
366
367int dvb_unregister_adapter(struct dvb_adapter *adap)
368{
369 mutex_lock(&dvbdev_register_lock);
370 list_del (&adap->list_head);
371 mutex_unlock(&dvbdev_register_lock);
372 return 0;
373}
374EXPORT_SYMBOL(dvb_unregister_adapter);
375
376
377
378
379
380
381int dvb_usercopy(struct file *file,
382 unsigned int cmd, unsigned long arg,
383 int (*func)(struct file *file,
384 unsigned int cmd, void *arg))
385{
386 char sbuf[128];
387 void *mbuf = NULL;
388 void *parg = NULL;
389 int err = -EINVAL;
390
391
392 switch (_IOC_DIR(cmd)) {
393 case _IOC_NONE:
394
395
396
397
398 parg = (void *) arg;
399 break;
400 case _IOC_READ:
401 case _IOC_WRITE:
402 case (_IOC_WRITE | _IOC_READ):
403 if (_IOC_SIZE(cmd) <= sizeof(sbuf)) {
404 parg = sbuf;
405 } else {
406
407 mbuf = kmalloc(_IOC_SIZE(cmd),GFP_KERNEL);
408 if (NULL == mbuf)
409 return -ENOMEM;
410 parg = mbuf;
411 }
412
413 err = -EFAULT;
414 if (copy_from_user(parg, (void __user *)arg, _IOC_SIZE(cmd)))
415 goto out;
416 break;
417 }
418
419
420 mutex_lock(&dvbdev_mutex);
421 if ((err = func(file, cmd, parg)) == -ENOIOCTLCMD)
422 err = -EINVAL;
423 mutex_unlock(&dvbdev_mutex);
424
425 if (err < 0)
426 goto out;
427
428
429 switch (_IOC_DIR(cmd))
430 {
431 case _IOC_READ:
432 case (_IOC_WRITE | _IOC_READ):
433 if (copy_to_user((void __user *)arg, parg, _IOC_SIZE(cmd)))
434 err = -EFAULT;
435 break;
436 }
437
438out:
439 kfree(mbuf);
440 return err;
441}
442
443static int dvb_uevent(struct device *dev, struct kobj_uevent_env *env)
444{
445 struct dvb_device *dvbdev = dev_get_drvdata(dev);
446
447 add_uevent_var(env, "DVB_ADAPTER_NUM=%d", dvbdev->adapter->num);
448 add_uevent_var(env, "DVB_DEVICE_TYPE=%s", dnames[dvbdev->type]);
449 add_uevent_var(env, "DVB_DEVICE_NUM=%d", dvbdev->id);
450 return 0;
451}
452
453static char *dvb_devnode(struct device *dev, mode_t *mode)
454{
455 struct dvb_device *dvbdev = dev_get_drvdata(dev);
456
457 return kasprintf(GFP_KERNEL, "dvb/adapter%d/%s%d",
458 dvbdev->adapter->num, dnames[dvbdev->type], dvbdev->id);
459}
460
461
462static int __init init_dvbdev(void)
463{
464 int retval;
465 dev_t dev = MKDEV(DVB_MAJOR, 0);
466
467 if ((retval = register_chrdev_region(dev, MAX_DVB_MINORS, "DVB")) != 0) {
468 printk(KERN_ERR "dvb-core: unable to get major %d\n", DVB_MAJOR);
469 return retval;
470 }
471
472 cdev_init(&dvb_device_cdev, &dvb_device_fops);
473 if ((retval = cdev_add(&dvb_device_cdev, dev, MAX_DVB_MINORS)) != 0) {
474 printk(KERN_ERR "dvb-core: unable register character device\n");
475 goto error;
476 }
477
478 dvb_class = class_create(THIS_MODULE, "dvb");
479 if (IS_ERR(dvb_class)) {
480 retval = PTR_ERR(dvb_class);
481 goto error;
482 }
483 dvb_class->dev_uevent = dvb_uevent;
484 dvb_class->devnode = dvb_devnode;
485 return 0;
486
487error:
488 cdev_del(&dvb_device_cdev);
489 unregister_chrdev_region(dev, MAX_DVB_MINORS);
490 return retval;
491}
492
493
494static void __exit exit_dvbdev(void)
495{
496 class_destroy(dvb_class);
497 cdev_del(&dvb_device_cdev);
498 unregister_chrdev_region(MKDEV(DVB_MAJOR, 0), MAX_DVB_MINORS);
499}
500
501subsys_initcall(init_dvbdev);
502module_exit(exit_dvbdev);
503
504MODULE_DESCRIPTION("DVB Core Driver");
505MODULE_AUTHOR("Marcus Metzler, Ralph Metzler, Holger Waechtler");
506MODULE_LICENSE("GPL");
507
