1 /* net/atm/resources.c - Statically allocated resources */
3 /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
6 * Arnaldo Carvalho de Melo <acme@conectiva.com.br>
7 * 2002/01 - don't free the whole struct sock on sk->destruct time,
8 * use the default destruct function initialized by sock_init_data */
11 #include <linux/config.h>
12 #include <linux/ctype.h>
13 #include <linux/string.h>
14 #include <linux/atmdev.h>
15 #include <linux/sonet.h>
16 #include <linux/kernel.h> /* for barrier */
17 #include <linux/module.h>
18 #include <linux/bitops.h>
19 #include <net/sock.h> /* for struct sock */
22 #include "resources.h"
27 spinlock_t atm_dev_lock
= SPIN_LOCK_UNLOCKED
;
29 static struct atm_dev
*__alloc_atm_dev(const char *type
)
33 dev
= kmalloc(sizeof(*dev
), GFP_KERNEL
);
36 memset(dev
, 0, sizeof(*dev
));
38 dev
->signal
= ATM_PHY_SIG_UNKNOWN
;
39 dev
->link_rate
= ATM_OC3_PCR
;
40 spin_lock_init(&dev
->lock
);
45 static void __free_atm_dev(struct atm_dev
*dev
)
50 static struct atm_dev
*__atm_dev_lookup(int number
)
55 list_for_each(p
, &atm_devs
) {
56 dev
= list_entry(p
, struct atm_dev
, dev_list
);
57 if ((dev
->ops
) && (dev
->number
== number
)) {
65 struct atm_dev
*atm_dev_lookup(int number
)
69 spin_lock(&atm_dev_lock
);
70 dev
= __atm_dev_lookup(number
);
71 spin_unlock(&atm_dev_lock
);
75 struct atm_dev
*atm_dev_register(const char *type
, const struct atmdev_ops
*ops
,
76 int number
, unsigned long *flags
)
78 struct atm_dev
*dev
, *inuse
;
80 dev
= __alloc_atm_dev(type
);
82 printk(KERN_ERR
"atm_dev_register: no space for dev %s\n",
86 spin_lock(&atm_dev_lock
);
88 if ((inuse
= __atm_dev_lookup(number
))) {
90 spin_unlock(&atm_dev_lock
);
97 while ((inuse
= __atm_dev_lookup(dev
->number
))) {
107 memset(&dev
->flags
, 0, sizeof(dev
->flags
));
108 memset(&dev
->stats
, 0, sizeof(dev
->stats
));
109 atomic_set(&dev
->refcnt
, 1);
110 list_add_tail(&dev
->dev_list
, &atm_devs
);
111 spin_unlock(&atm_dev_lock
);
113 if (atm_proc_dev_register(dev
) < 0) {
114 printk(KERN_ERR
"atm_dev_register: "
115 "atm_proc_dev_register failed for dev %s\n",
117 spin_lock(&atm_dev_lock
);
118 list_del(&dev
->dev_list
);
119 spin_unlock(&atm_dev_lock
);
128 void atm_dev_deregister(struct atm_dev
*dev
)
130 unsigned long warning_time
;
132 atm_proc_dev_deregister(dev
);
134 spin_lock(&atm_dev_lock
);
135 list_del(&dev
->dev_list
);
136 spin_unlock(&atm_dev_lock
);
138 warning_time
= jiffies
;
139 while (atomic_read(&dev
->refcnt
) != 1) {
140 current
->state
= TASK_INTERRUPTIBLE
;
141 schedule_timeout(HZ
/ 4);
142 if ((jiffies
- warning_time
) > 10 * HZ
) {
143 printk(KERN_EMERG
"atm_dev_deregister: waiting for "
144 "dev %d to become free. Usage count = %d\n",
145 dev
->number
, atomic_read(&dev
->refcnt
));
146 warning_time
= jiffies
;
153 void shutdown_atm_dev(struct atm_dev
*dev
)
155 if (atomic_read(&dev
->refcnt
) > 1) {
156 set_bit(ATM_DF_CLOSE
, &dev
->flags
);
159 if (dev
->ops
->dev_close
)
160 dev
->ops
->dev_close(dev
);
161 atm_dev_deregister(dev
);
165 static void copy_aal_stats(struct k_atm_aal_stats
*from
,
166 struct atm_aal_stats
*to
)
168 #define __HANDLE_ITEM(i) to->i = atomic_read(&from->i)
174 static void subtract_aal_stats(struct k_atm_aal_stats
*from
,
175 struct atm_aal_stats
*to
)
177 #define __HANDLE_ITEM(i) atomic_sub(to->i, &from->i)
183 static int fetch_stats(struct atm_dev
*dev
, struct atm_dev_stats
*arg
, int zero
)
185 struct atm_dev_stats tmp
;
188 copy_aal_stats(&dev
->stats
.aal0
, &tmp
.aal0
);
189 copy_aal_stats(&dev
->stats
.aal34
, &tmp
.aal34
);
190 copy_aal_stats(&dev
->stats
.aal5
, &tmp
.aal5
);
192 error
= copy_to_user(arg
, &tmp
, sizeof(tmp
));
193 if (zero
&& !error
) {
194 subtract_aal_stats(&dev
->stats
.aal0
, &tmp
.aal0
);
195 subtract_aal_stats(&dev
->stats
.aal34
, &tmp
.aal34
);
196 subtract_aal_stats(&dev
->stats
.aal5
, &tmp
.aal5
);
198 return error
? -EFAULT
: 0;
202 int atm_dev_ioctl(unsigned int cmd
, unsigned long arg
)
205 int error
, len
, number
, size
= 0;
208 int *tmp_buf
, *tmp_p
;
212 if (get_user(buf
, &((struct atm_iobuf
*) arg
)->buffer
))
214 if (get_user(len
, &((struct atm_iobuf
*) arg
)->length
))
216 spin_lock(&atm_dev_lock
);
217 list_for_each(p
, &atm_devs
)
220 spin_unlock(&atm_dev_lock
);
223 tmp_buf
= kmalloc(size
, GFP_ATOMIC
);
225 spin_unlock(&atm_dev_lock
);
229 list_for_each(p
, &atm_devs
) {
230 dev
= list_entry(p
, struct atm_dev
, dev_list
);
231 *tmp_p
++ = dev
->number
;
233 spin_unlock(&atm_dev_lock
);
234 error
= ((copy_to_user(buf
, tmp_buf
, size
)) ||
235 put_user(size
, &((struct atm_iobuf
*) arg
)->length
))
243 if (get_user(buf
, &((struct atmif_sioc
*) arg
)->arg
))
245 if (get_user(len
, &((struct atmif_sioc
*) arg
)->length
))
247 if (get_user(number
, &((struct atmif_sioc
*) arg
)->number
))
250 if (!(dev
= atm_dev_lookup(number
)))
255 size
= strlen(dev
->type
) + 1;
256 if (copy_to_user(buf
, dev
->type
, size
)) {
263 if (copy_to_user(buf
, dev
->esi
, size
)) {
272 for (i
= 0; i
< ESI_LEN
; i
++)
281 unsigned char esi
[ESI_LEN
];
283 if (!capable(CAP_NET_ADMIN
)) {
287 if (copy_from_user(esi
, buf
, ESI_LEN
)) {
291 memcpy(dev
->esi
, esi
, ESI_LEN
);
296 if (!capable(CAP_NET_ADMIN
)) {
302 size
= sizeof(struct atm_dev_stats
);
303 error
= fetch_stats(dev
, buf
, cmd
== ATM_GETSTATZ
);
308 size
= sizeof(struct atm_cirange
);
309 if (copy_to_user(buf
, &dev
->ci_range
, size
)) {
314 case ATM_GETLINKRATE
:
316 if (copy_to_user(buf
, &dev
->link_rate
, size
)) {
322 if (!capable(CAP_NET_ADMIN
)) {
330 if (!capable(CAP_NET_ADMIN
)) {
335 struct sockaddr_atmsvc addr
;
337 if (copy_from_user(&addr
, buf
, sizeof(addr
))) {
341 if (cmd
== ATM_ADDADDR
)
342 error
= atm_add_addr(dev
, &addr
);
344 error
= atm_del_addr(dev
, &addr
);
348 error
= atm_get_addr(dev
, buf
, len
);
352 /* may return 0, but later on size == 0 means "don't
354 error
= put_user(size
, &((struct atmif_sioc
*) arg
)->length
)
358 if (__ATM_LM_XTRMT((int) (long) buf
) &&
359 __ATM_LM_XTLOC((int) (long) buf
) >
360 __ATM_LM_XTRMT((int) (long) buf
)) {
369 case SONET_SETFRAMING
:
370 if (!capable(CAP_NET_ADMIN
)) {
376 if (!dev
->ops
->ioctl
) {
380 size
= dev
->ops
->ioctl(dev
, cmd
, buf
);
382 error
= (size
== -ENOIOCTLCMD
? -EINVAL
: size
);
388 error
= put_user(size
, &((struct atmif_sioc
*) arg
)->length
)
397 static __inline__
void *dev_get_idx(loff_t left
)
401 list_for_each(p
, &atm_devs
) {
405 return (p
!= &atm_devs
) ? p
: NULL
;
408 void *atm_dev_seq_start(struct seq_file
*seq
, loff_t
*pos
)
410 spin_lock(&atm_dev_lock
);
411 return *pos
? dev_get_idx(*pos
) : (void *) 1;
414 void atm_dev_seq_stop(struct seq_file
*seq
, void *v
)
416 spin_unlock(&atm_dev_lock
);
419 void *atm_dev_seq_next(struct seq_file
*seq
, void *v
, loff_t
*pos
)
422 v
= (v
== (void *)1) ? atm_devs
.next
: ((struct list_head
*)v
)->next
;
423 return (v
== &atm_devs
) ? NULL
: v
;
427 EXPORT_SYMBOL(atm_dev_register
);
428 EXPORT_SYMBOL(atm_dev_deregister
);
429 EXPORT_SYMBOL(atm_dev_lookup
);
430 EXPORT_SYMBOL(shutdown_atm_dev
);