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 */
10 #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
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 <linux/capability.h>
20 #include <linux/delay.h>
21 #include <linux/mutex.h>
23 #include <net/sock.h> /* for struct sock */
26 #include "resources.h"
31 DEFINE_MUTEX(atm_dev_mutex
);
33 static struct atm_dev
*__alloc_atm_dev(const char *type
)
37 dev
= kzalloc(sizeof(*dev
), GFP_KERNEL
);
41 dev
->signal
= ATM_PHY_SIG_UNKNOWN
;
42 dev
->link_rate
= ATM_OC3_PCR
;
43 spin_lock_init(&dev
->lock
);
44 INIT_LIST_HEAD(&dev
->local
);
45 INIT_LIST_HEAD(&dev
->lecs
);
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
->number
== number
) {
65 struct atm_dev
*atm_dev_lookup(int number
)
69 mutex_lock(&atm_dev_mutex
);
70 dev
= __atm_dev_lookup(number
);
71 mutex_unlock(&atm_dev_mutex
);
74 EXPORT_SYMBOL(atm_dev_lookup
);
76 struct atm_dev
*atm_dev_register(const char *type
, const struct atmdev_ops
*ops
,
77 int number
, unsigned long *flags
)
79 struct atm_dev
*dev
, *inuse
;
81 dev
= __alloc_atm_dev(type
);
83 pr_err("no space for dev %s\n", type
);
86 mutex_lock(&atm_dev_mutex
);
88 inuse
= __atm_dev_lookup(number
);
91 mutex_unlock(&atm_dev_mutex
);
98 while ((inuse
= __atm_dev_lookup(dev
->number
))) {
108 memset(&dev
->flags
, 0, sizeof(dev
->flags
));
109 memset(&dev
->stats
, 0, sizeof(dev
->stats
));
110 atomic_set(&dev
->refcnt
, 1);
112 if (atm_proc_dev_register(dev
) < 0) {
113 pr_err("atm_proc_dev_register failed for dev %s\n", type
);
117 if (atm_register_sysfs(dev
) < 0) {
118 pr_err("atm_register_sysfs failed for dev %s\n", type
);
119 atm_proc_dev_deregister(dev
);
123 list_add_tail(&dev
->dev_list
, &atm_devs
);
126 mutex_unlock(&atm_dev_mutex
);
134 EXPORT_SYMBOL(atm_dev_register
);
136 void atm_dev_deregister(struct atm_dev
*dev
)
138 BUG_ON(test_bit(ATM_DF_REMOVED
, &dev
->flags
));
139 set_bit(ATM_DF_REMOVED
, &dev
->flags
);
142 * if we remove current device from atm_devs list, new device
143 * with same number can appear, such we need deregister proc,
144 * release async all vccs and remove them from vccs list too
146 mutex_lock(&atm_dev_mutex
);
147 list_del(&dev
->dev_list
);
148 mutex_unlock(&atm_dev_mutex
);
150 atm_dev_release_vccs(dev
);
151 atm_unregister_sysfs(dev
);
152 atm_proc_dev_deregister(dev
);
156 EXPORT_SYMBOL(atm_dev_deregister
);
158 static void copy_aal_stats(struct k_atm_aal_stats
*from
,
159 struct atm_aal_stats
*to
)
161 #define __HANDLE_ITEM(i) to->i = atomic_read(&from->i)
166 static void subtract_aal_stats(struct k_atm_aal_stats
*from
,
167 struct atm_aal_stats
*to
)
169 #define __HANDLE_ITEM(i) atomic_sub(to->i, &from->i)
174 static int fetch_stats(struct atm_dev
*dev
, struct atm_dev_stats __user
*arg
,
177 struct atm_dev_stats tmp
;
180 copy_aal_stats(&dev
->stats
.aal0
, &tmp
.aal0
);
181 copy_aal_stats(&dev
->stats
.aal34
, &tmp
.aal34
);
182 copy_aal_stats(&dev
->stats
.aal5
, &tmp
.aal5
);
184 error
= copy_to_user(arg
, &tmp
, sizeof(tmp
));
185 if (zero
&& !error
) {
186 subtract_aal_stats(&dev
->stats
.aal0
, &tmp
.aal0
);
187 subtract_aal_stats(&dev
->stats
.aal34
, &tmp
.aal34
);
188 subtract_aal_stats(&dev
->stats
.aal5
, &tmp
.aal5
);
190 return error
? -EFAULT
: 0;
193 int atm_dev_ioctl(unsigned int cmd
, void __user
*arg
, int compat
)
196 int error
, len
, number
, size
= 0;
199 int *tmp_buf
, *tmp_p
;
200 int __user
*sioc_len
;
201 int __user
*iobuf_len
;
203 #ifndef CONFIG_COMPAT
204 compat
= 0; /* Just so the compiler _knows_ */
211 struct compat_atm_iobuf __user
*ciobuf
= arg
;
213 iobuf_len
= &ciobuf
->length
;
214 if (get_user(cbuf
, &ciobuf
->buffer
))
216 buf
= compat_ptr(cbuf
);
219 struct atm_iobuf __user
*iobuf
= arg
;
220 iobuf_len
= &iobuf
->length
;
221 if (get_user(buf
, &iobuf
->buffer
))
224 if (get_user(len
, iobuf_len
))
226 mutex_lock(&atm_dev_mutex
);
227 list_for_each(p
, &atm_devs
)
230 mutex_unlock(&atm_dev_mutex
);
233 tmp_buf
= kmalloc(size
, GFP_ATOMIC
);
235 mutex_unlock(&atm_dev_mutex
);
239 list_for_each(p
, &atm_devs
) {
240 dev
= list_entry(p
, struct atm_dev
, dev_list
);
241 *tmp_p
++ = dev
->number
;
243 mutex_unlock(&atm_dev_mutex
);
244 error
= ((copy_to_user(buf
, tmp_buf
, size
)) ||
245 put_user(size
, iobuf_len
))
255 struct compat_atmif_sioc __user
*csioc
= arg
;
258 sioc_len
= &csioc
->length
;
259 if (get_user(carg
, &csioc
->arg
))
261 buf
= compat_ptr(carg
);
263 if (get_user(len
, &csioc
->length
))
265 if (get_user(number
, &csioc
->number
))
269 struct atmif_sioc __user
*sioc
= arg
;
271 sioc_len
= &sioc
->length
;
272 if (get_user(buf
, &sioc
->arg
))
274 if (get_user(len
, &sioc
->length
))
276 if (get_user(number
, &sioc
->number
))
280 dev
= try_then_request_module(atm_dev_lookup(number
), "atm-device-%d",
287 size
= strlen(dev
->type
) + 1;
288 if (copy_to_user(buf
, dev
->type
, size
)) {
295 if (copy_to_user(buf
, dev
->esi
, size
)) {
304 for (i
= 0; i
< ESI_LEN
; i
++)
313 unsigned char esi
[ESI_LEN
];
315 if (!capable(CAP_NET_ADMIN
)) {
319 if (copy_from_user(esi
, buf
, ESI_LEN
)) {
323 memcpy(dev
->esi
, esi
, ESI_LEN
);
328 if (!capable(CAP_NET_ADMIN
)) {
334 size
= sizeof(struct atm_dev_stats
);
335 error
= fetch_stats(dev
, buf
, cmd
== ATM_GETSTATZ
);
340 size
= sizeof(struct atm_cirange
);
341 if (copy_to_user(buf
, &dev
->ci_range
, size
)) {
346 case ATM_GETLINKRATE
:
348 if (copy_to_user(buf
, &dev
->link_rate
, size
)) {
354 if (!capable(CAP_NET_ADMIN
)) {
358 atm_reset_addr(dev
, ATM_ADDR_LOCAL
);
362 case ATM_ADDLECSADDR
:
363 case ATM_DELLECSADDR
:
365 struct sockaddr_atmsvc addr
;
367 if (!capable(CAP_NET_ADMIN
)) {
372 if (copy_from_user(&addr
, buf
, sizeof(addr
))) {
376 if (cmd
== ATM_ADDADDR
|| cmd
== ATM_ADDLECSADDR
)
377 error
= atm_add_addr(dev
, &addr
,
378 (cmd
== ATM_ADDADDR
?
379 ATM_ADDR_LOCAL
: ATM_ADDR_LECS
));
381 error
= atm_del_addr(dev
, &addr
,
382 (cmd
== ATM_DELADDR
?
383 ATM_ADDR_LOCAL
: ATM_ADDR_LECS
));
387 case ATM_GETLECSADDR
:
388 error
= atm_get_addr(dev
, buf
, len
,
389 (cmd
== ATM_GETADDR
?
390 ATM_ADDR_LOCAL
: ATM_ADDR_LECS
));
394 /* may return 0, but later on size == 0 means "don't
396 error
= put_user(size
, sioc_len
) ? -EFAULT
: 0;
399 if (__ATM_LM_XTRMT((int) (unsigned long) buf
) &&
400 __ATM_LM_XTLOC((int) (unsigned long) buf
) >
401 __ATM_LM_XTRMT((int) (unsigned long) buf
)) {
410 case SONET_SETFRAMING
:
411 if (!capable(CAP_NET_ADMIN
)) {
419 if (!dev
->ops
->compat_ioctl
) {
423 size
= dev
->ops
->compat_ioctl(dev
, cmd
, buf
);
426 if (!dev
->ops
->ioctl
) {
430 size
= dev
->ops
->ioctl(dev
, cmd
, buf
);
433 error
= (size
== -ENOIOCTLCMD
? -EINVAL
: size
);
439 error
= put_user(size
, sioc_len
) ? -EFAULT
: 0;
447 void *atm_dev_seq_start(struct seq_file
*seq
, loff_t
*pos
)
449 mutex_lock(&atm_dev_mutex
);
450 return seq_list_start_head(&atm_devs
, *pos
);
453 void atm_dev_seq_stop(struct seq_file
*seq
, void *v
)
455 mutex_unlock(&atm_dev_mutex
);
458 void *atm_dev_seq_next(struct seq_file
*seq
, void *v
, loff_t
*pos
)
460 return seq_list_next(v
, &atm_devs
, pos
);