1 /* net/atm/resources.c - Staticly allocated resources */
3 /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
6 #include <linux/config.h>
7 #include <linux/ctype.h>
8 #include <linux/string.h>
9 #include <linux/atmdev.h>
10 #include <linux/sonet.h>
11 #include <linux/kernel.h> /* for barrier */
12 #include <linux/module.h>
13 #include <linux/bitops.h>
14 #include <net/sock.h> /* for struct sock */
15 #include <asm/segment.h> /* for get_fs_long and put_fs_long */
18 #include "resources.h"
23 spinlock_t atm_dev_lock = SPIN_LOCK_UNLOCKED;
26 static struct atm_dev *__alloc_atm_dev(const char *type)
30 dev = kmalloc(sizeof(*dev), GFP_ATOMIC);
33 memset(dev, 0, sizeof(*dev));
35 dev->signal = ATM_PHY_SIG_UNKNOWN;
36 dev->link_rate = ATM_OC3_PCR;
37 spin_lock_init(&dev->lock);
43 static void __free_atm_dev(struct atm_dev *dev)
48 static struct atm_dev *__atm_dev_lookup(int number)
53 list_for_each(p, &atm_devs) {
54 dev = list_entry(p, struct atm_dev, dev_list);
55 if ((dev->ops) && (dev->number == number)) {
63 struct atm_dev *atm_dev_lookup(int number)
67 spin_lock(&atm_dev_lock);
68 dev = __atm_dev_lookup(number);
69 spin_unlock(&atm_dev_lock);
73 struct atm_dev *atm_dev_register(const char *type, const struct atmdev_ops *ops,
74 int number, atm_dev_flags_t *flags)
76 struct atm_dev *dev, *inuse;
79 dev = __alloc_atm_dev(type);
81 printk(KERN_ERR "atm_dev_register: no space for dev %s\n",
85 spin_lock(&atm_dev_lock);
87 if ((inuse = __atm_dev_lookup(number))) {
89 spin_unlock(&atm_dev_lock);
96 while ((inuse = __atm_dev_lookup(dev->number))) {
106 memset(&dev->flags, 0, sizeof(dev->flags));
107 memset(&dev->stats, 0, sizeof(dev->stats));
108 atomic_set(&dev->refcnt, 1);
109 list_add_tail(&dev->dev_list, &atm_devs);
110 spin_unlock(&atm_dev_lock);
112 #ifdef CONFIG_PROC_FS
113 if (ops->proc_read) {
114 if (atm_proc_dev_register(dev) < 0) {
115 printk(KERN_ERR "atm_dev_register: "
116 "atm_proc_dev_register failed for dev %s\n",
118 spin_lock(&atm_dev_lock);
119 list_del(&dev->dev_list);
120 spin_unlock(&atm_dev_lock);
131 void atm_dev_deregister(struct atm_dev *dev)
133 unsigned long warning_time;
135 #ifdef CONFIG_PROC_FS
136 if (dev->ops->proc_read)
137 atm_proc_dev_deregister(dev);
139 spin_lock(&atm_dev_lock);
140 list_del(&dev->dev_list);
141 spin_unlock(&atm_dev_lock);
143 warning_time = jiffies;
144 while (atomic_read(&dev->refcnt) != 1) {
145 current->state = TASK_INTERRUPTIBLE;
146 schedule_timeout(HZ / 4);
147 current->state = TASK_RUNNING;
148 if ((jiffies - warning_time) > 10 * HZ) {
149 printk(KERN_EMERG "atm_dev_deregister: waiting for "
150 "dev %d to become free. Usage count = %d\n",
151 dev->number, atomic_read(&dev->refcnt));
152 warning_time = jiffies;
159 void shutdown_atm_dev(struct atm_dev *dev)
161 if (atomic_read(&dev->refcnt) > 1) {
162 set_bit(ATM_DF_CLOSE, &dev->flags);
165 if (dev->ops->dev_close)
166 dev->ops->dev_close(dev);
167 atm_dev_deregister(dev);
171 static void copy_aal_stats(struct k_atm_aal_stats *from,
172 struct atm_aal_stats *to)
174 #define __HANDLE_ITEM(i) to->i = atomic_read(&from->i)
180 static void subtract_aal_stats(struct k_atm_aal_stats *from,
181 struct atm_aal_stats *to)
183 #define __HANDLE_ITEM(i) atomic_sub(to->i, &from->i)
189 static int fetch_stats(struct atm_dev *dev, struct atm_dev_stats *arg, int zero)
191 struct atm_dev_stats tmp;
194 copy_aal_stats(&dev->stats.aal0, &tmp.aal0);
195 copy_aal_stats(&dev->stats.aal34, &tmp.aal34);
196 copy_aal_stats(&dev->stats.aal5, &tmp.aal5);
198 error = copy_to_user(arg, &tmp, sizeof(tmp));
199 if (zero && !error) {
200 subtract_aal_stats(&dev->stats.aal0, &tmp.aal0);
201 subtract_aal_stats(&dev->stats.aal34, &tmp.aal34);
202 subtract_aal_stats(&dev->stats.aal5, &tmp.aal5);
204 return error ? -EFAULT : 0;
208 int atm_dev_ioctl(unsigned int cmd, unsigned long arg)
211 int error = 0, len, number, size = 0;
214 if (cmd == ATM_GETNAMES) {
215 int *tmp_buf, *tmp_bufp;
218 * ATM_GETNAMES is a special case: it doesn't require a
219 * device number argument
221 if (get_user(buf, &((struct atm_iobuf *) arg)->buffer))
223 if (get_user(len, &((struct atm_iobuf *) arg)->length))
225 spin_lock(&atm_dev_lock);
226 list_for_each(p, &atm_devs)
229 spin_unlock(&atm_dev_lock);
232 tmp_buf = tmp_bufp = kmalloc(size, GFP_ATOMIC);
234 spin_unlock(&atm_dev_lock);
237 list_for_each(p, &atm_devs) {
238 dev = list_entry(p, struct atm_dev, dev_list);
239 *tmp_bufp++ = dev->number;
241 spin_unlock(&atm_dev_lock);
242 error = (copy_to_user(buf, tmp_buf, size) ||
243 put_user(size, &((struct atm_iobuf *) arg)->length))
249 if (get_user(buf, &((struct atmif_sioc *) arg)->arg))
251 if (get_user(len, &((struct atmif_sioc *) arg)->length))
253 if (get_user(number, &((struct atmif_sioc *) arg)->number))
256 if (!(dev = atm_dev_lookup(number)))
261 size = strlen(dev->type) + 1;
262 if (copy_to_user(buf, dev->type, size)) {
269 if (copy_to_user(buf, dev->esi, size)) {
278 for (i = 0; i < ESI_LEN; i++)
287 unsigned char esi[ESI_LEN];
289 if (!capable(CAP_NET_ADMIN)) {
293 if (copy_from_user(esi, buf, ESI_LEN)) {
297 memcpy(dev->esi, esi, ESI_LEN);
302 if (!capable(CAP_NET_ADMIN)) {
308 size = sizeof(struct atm_dev_stats);
309 error = fetch_stats(dev, buf, cmd == ATM_GETSTATZ);
314 size = sizeof(struct atm_cirange);
315 if (copy_to_user(buf, &dev->ci_range, size)) {
320 case ATM_GETLINKRATE:
322 if (copy_to_user(buf, &dev->link_rate, size)) {
328 if (!capable(CAP_NET_ADMIN)) {
336 if (!capable(CAP_NET_ADMIN)) {
341 struct sockaddr_atmsvc addr;
343 if (copy_from_user(&addr, buf, sizeof(addr))) {
347 if (cmd == ATM_ADDADDR)
348 error = atm_add_addr(dev, &addr);
350 error = atm_del_addr(dev, &addr);
354 error = atm_get_addr(dev, buf, len);
358 /* write back size even if it's zero */
361 if (__ATM_LM_XTRMT((int) (long) buf) &&
362 __ATM_LM_XTLOC((int) (long) buf) >
363 __ATM_LM_XTRMT((int) (long) buf)) {
372 case SONET_SETFRAMING:
373 if (!capable(CAP_NET_ADMIN)) {
379 if (!dev->ops->ioctl) {
383 size = dev->ops->ioctl(dev, cmd, buf);
385 error = (size == -ENOIOCTLCMD ? -EINVAL : size);
392 error = put_user(size,
393 &((struct atmif_sioc *) arg)->length)
402 EXPORT_SYMBOL(atm_dev_register);
403 EXPORT_SYMBOL(atm_dev_deregister);
404 EXPORT_SYMBOL(atm_dev_lookup);
405 EXPORT_SYMBOL(shutdown_atm_dev);