| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | /* | 
 | 2 |  *            Telephony registration for Linux | 
 | 3 |  * | 
 | 4 |  *              (c) Copyright 1999 Red Hat Software Inc. | 
 | 5 |  * | 
 | 6 |  *              This program is free software; you can redistribute it and/or | 
 | 7 |  *              modify it under the terms of the GNU General Public License | 
 | 8 |  *              as published by the Free Software Foundation; either version | 
 | 9 |  *              2 of the License, or (at your option) any later version. | 
 | 10 |  * | 
| Alan Cox | 0906dd9 | 2008-11-11 14:51:23 +0000 | [diff] [blame] | 11 |  * Author:      Alan Cox, <alan@lxorguk.ukuu.org.uk> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 12 |  * | 
 | 13 |  * Fixes:       Mar 01 2000 Thomas Sparr, <thomas.l.sparr@telia.com> | 
 | 14 |  *              phone_register_device now works with unit!=PHONE_UNIT_ANY | 
 | 15 |  */ | 
 | 16 |  | 
 | 17 | #include <linux/module.h> | 
 | 18 | #include <linux/types.h> | 
 | 19 | #include <linux/kernel.h> | 
 | 20 | #include <linux/fs.h> | 
 | 21 | #include <linux/mm.h> | 
 | 22 | #include <linux/string.h> | 
 | 23 | #include <linux/errno.h> | 
 | 24 | #include <linux/phonedev.h> | 
 | 25 | #include <linux/init.h> | 
 | 26 | #include <asm/uaccess.h> | 
 | 27 | #include <asm/system.h> | 
 | 28 |  | 
 | 29 | #include <linux/kmod.h> | 
 | 30 | #include <linux/sem.h> | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 31 | #include <linux/mutex.h> | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 32 |  | 
 | 33 | #define PHONE_NUM_DEVICES	256 | 
 | 34 |  | 
 | 35 | /* | 
 | 36 |  *    Active devices  | 
 | 37 |  */ | 
 | 38 |  | 
 | 39 | static struct phone_device *phone_device[PHONE_NUM_DEVICES]; | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 40 | static DEFINE_MUTEX(phone_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 41 |  | 
 | 42 | /* | 
 | 43 |  *    Open a phone device. | 
 | 44 |  */ | 
 | 45 |  | 
 | 46 | static int phone_open(struct inode *inode, struct file *file) | 
 | 47 | { | 
 | 48 | 	unsigned int minor = iminor(inode); | 
 | 49 | 	int err = 0; | 
 | 50 | 	struct phone_device *p; | 
| Arjan van de Ven | 99ac48f | 2006-03-28 01:56:41 -0800 | [diff] [blame] | 51 | 	const struct file_operations *old_fops, *new_fops = NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 52 |  | 
 | 53 | 	if (minor >= PHONE_NUM_DEVICES) | 
 | 54 | 		return -ENODEV; | 
 | 55 |  | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 56 | 	mutex_lock(&phone_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | 	p = phone_device[minor]; | 
 | 58 | 	if (p) | 
 | 59 | 		new_fops = fops_get(p->f_op); | 
 | 60 | 	if (!new_fops) { | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 61 | 		mutex_unlock(&phone_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | 		request_module("char-major-%d-%d", PHONE_MAJOR, minor); | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 63 | 		mutex_lock(&phone_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 64 | 		p = phone_device[minor]; | 
 | 65 | 		if (p == NULL || (new_fops = fops_get(p->f_op)) == NULL) | 
 | 66 | 		{ | 
 | 67 | 			err=-ENODEV; | 
 | 68 | 			goto end; | 
 | 69 | 		} | 
 | 70 | 	} | 
 | 71 | 	old_fops = file->f_op; | 
 | 72 | 	file->f_op = new_fops; | 
 | 73 | 	if (p->open) | 
 | 74 | 		err = p->open(p, file);	/* Tell the device it is open */ | 
 | 75 | 	if (err) { | 
 | 76 | 		fops_put(file->f_op); | 
 | 77 | 		file->f_op = fops_get(old_fops); | 
 | 78 | 	} | 
 | 79 | 	fops_put(old_fops); | 
 | 80 | end: | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 81 | 	mutex_unlock(&phone_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 82 | 	return err; | 
 | 83 | } | 
 | 84 |  | 
 | 85 | /* | 
 | 86 |  *    Telephony For Linux device drivers request registration here. | 
 | 87 |  */ | 
 | 88 |  | 
 | 89 | int phone_register_device(struct phone_device *p, int unit) | 
 | 90 | { | 
 | 91 | 	int base; | 
 | 92 | 	int end; | 
 | 93 | 	int i; | 
 | 94 |  | 
 | 95 | 	base = 0; | 
 | 96 | 	end = PHONE_NUM_DEVICES - 1; | 
 | 97 |  | 
 | 98 | 	if (unit != PHONE_UNIT_ANY) { | 
 | 99 | 		base = unit; | 
 | 100 | 		end = unit + 1;  /* enter the loop at least one time */ | 
 | 101 | 	} | 
 | 102 | 	 | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 103 | 	mutex_lock(&phone_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 104 | 	for (i = base; i < end; i++) { | 
 | 105 | 		if (phone_device[i] == NULL) { | 
 | 106 | 			phone_device[i] = p; | 
 | 107 | 			p->minor = i; | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 108 | 			mutex_unlock(&phone_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 109 | 			return 0; | 
 | 110 | 		} | 
 | 111 | 	} | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 112 | 	mutex_unlock(&phone_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | 	return -ENFILE; | 
 | 114 | } | 
 | 115 |  | 
 | 116 | /* | 
 | 117 |  *    Unregister an unused Telephony for linux device | 
 | 118 |  */ | 
 | 119 |  | 
 | 120 | void phone_unregister_device(struct phone_device *pfd) | 
 | 121 | { | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 122 | 	mutex_lock(&phone_lock); | 
| Matti Linnanvuori | 01aae97 | 2007-11-05 14:51:02 -0800 | [diff] [blame] | 123 | 	if (likely(phone_device[pfd->minor] == pfd)) | 
 | 124 | 		phone_device[pfd->minor] = NULL; | 
| Ingo Molnar | 14cc3e2 | 2006-03-26 01:37:14 -0800 | [diff] [blame] | 125 | 	mutex_unlock(&phone_lock); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 126 | } | 
 | 127 |  | 
 | 128 |  | 
| Arjan van de Ven | 00977a5 | 2007-02-12 00:55:34 -0800 | [diff] [blame] | 129 | static const struct file_operations phone_fops = | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 130 | { | 
 | 131 | 	.owner		= THIS_MODULE, | 
 | 132 | 	.open		= phone_open, | 
| Arnd Bergmann | 6038f37 | 2010-08-15 18:52:59 +0200 | [diff] [blame] | 133 | 	.llseek		= noop_llseek, | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 134 | }; | 
 | 135 |  | 
 | 136 | /* | 
 | 137 |  *	Board init functions | 
 | 138 |  */ | 
 | 139 |   | 
 | 140 |  | 
 | 141 | /* | 
 | 142 |  *    Initialise Telephony for linux | 
 | 143 |  */ | 
 | 144 |  | 
 | 145 | static int __init telephony_init(void) | 
 | 146 | { | 
 | 147 | 	printk(KERN_INFO "Linux telephony interface: v1.00\n"); | 
 | 148 | 	if (register_chrdev(PHONE_MAJOR, "telephony", &phone_fops)) { | 
 | 149 | 		printk("phonedev: unable to get major %d\n", PHONE_MAJOR); | 
 | 150 | 		return -EIO; | 
 | 151 | 	} | 
 | 152 |  | 
 | 153 | 	return 0; | 
 | 154 | } | 
 | 155 |  | 
 | 156 | static void __exit telephony_exit(void) | 
 | 157 | { | 
 | 158 | 	unregister_chrdev(PHONE_MAJOR, "telephony"); | 
 | 159 | } | 
 | 160 |  | 
 | 161 | module_init(telephony_init); | 
 | 162 | module_exit(telephony_exit); | 
 | 163 |  | 
 | 164 | MODULE_LICENSE("GPL"); | 
 | 165 |  | 
 | 166 | EXPORT_SYMBOL(phone_register_device); | 
 | 167 | EXPORT_SYMBOL(phone_unregister_device); |