]> bbs.cooldavid.org Git - net-next-2.6.git/blame - net/atm/resources.c
net: atm: use seq_list_foo() helpers
[net-next-2.6.git] / net / atm / resources.c
CommitLineData
1da177e4
LT
1/* net/atm/resources.c - Statically allocated resources */
2
3/* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
4
5/* Fixes
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 */
9
99824461 10#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
1da177e4 11
1da177e4
LT
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>
4fc268d2 19#include <linux/capability.h>
1da177e4 20#include <linux/delay.h>
57b47a53
IM
21#include <linux/mutex.h>
22
1da177e4
LT
23#include <net/sock.h> /* for struct sock */
24
25#include "common.h"
26#include "resources.h"
27#include "addr.h"
28
29
30LIST_HEAD(atm_devs);
57b47a53 31DEFINE_MUTEX(atm_dev_mutex);
1da177e4
LT
32
33static struct atm_dev *__alloc_atm_dev(const char *type)
34{
35 struct atm_dev *dev;
36
0da974f4 37 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
1da177e4
LT
38 if (!dev)
39 return NULL;
1da177e4
LT
40 dev->type = type;
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);
0f21ba7c 45 INIT_LIST_HEAD(&dev->lecs);
1da177e4
LT
46
47 return dev;
48}
49
1da177e4
LT
50static struct atm_dev *__atm_dev_lookup(int number)
51{
52 struct atm_dev *dev;
53 struct list_head *p;
54
55 list_for_each(p, &atm_devs) {
56 dev = list_entry(p, struct atm_dev, dev_list);
aaaaaadb 57 if (dev->number == number) {
1da177e4
LT
58 atm_dev_hold(dev);
59 return dev;
60 }
61 }
62 return NULL;
63}
64
65struct atm_dev *atm_dev_lookup(int number)
66{
67 struct atm_dev *dev;
68
57b47a53 69 mutex_lock(&atm_dev_mutex);
1da177e4 70 dev = __atm_dev_lookup(number);
57b47a53 71 mutex_unlock(&atm_dev_mutex);
1da177e4
LT
72 return dev;
73}
07b54c9a 74EXPORT_SYMBOL(atm_dev_lookup);
64bf69dd 75
1da177e4
LT
76struct atm_dev *atm_dev_register(const char *type, const struct atmdev_ops *ops,
77 int number, unsigned long *flags)
78{
79 struct atm_dev *dev, *inuse;
80
81 dev = __alloc_atm_dev(type);
82 if (!dev) {
99824461 83 pr_err("no space for dev %s\n", type);
1da177e4
LT
84 return NULL;
85 }
57b47a53 86 mutex_lock(&atm_dev_mutex);
1da177e4 87 if (number != -1) {
07b54c9a
JP
88 inuse = __atm_dev_lookup(number);
89 if (inuse) {
1da177e4 90 atm_dev_put(inuse);
57b47a53 91 mutex_unlock(&atm_dev_mutex);
ebc37b61 92 kfree(dev);
1da177e4
LT
93 return NULL;
94 }
95 dev->number = number;
96 } else {
97 dev->number = 0;
98 while ((inuse = __atm_dev_lookup(dev->number))) {
99 atm_dev_put(inuse);
100 dev->number++;
101 }
102 }
103
104 dev->ops = ops;
105 if (flags)
106 dev->flags = *flags;
107 else
108 memset(&dev->flags, 0, sizeof(dev->flags));
109 memset(&dev->stats, 0, sizeof(dev->stats));
110 atomic_set(&dev->refcnt, 1);
1da177e4
LT
111
112 if (atm_proc_dev_register(dev) < 0) {
99824461 113 pr_err("atm_proc_dev_register failed for dev %s\n", type);
656d98b0
RK
114 goto out_fail;
115 }
116
117 if (atm_register_sysfs(dev) < 0) {
99824461 118 pr_err("atm_register_sysfs failed for dev %s\n", type);
656d98b0
RK
119 atm_proc_dev_deregister(dev);
120 goto out_fail;
1da177e4 121 }
656d98b0 122
aaaaaadb 123 list_add_tail(&dev->dev_list, &atm_devs);
1da177e4 124
656d98b0
RK
125out:
126 mutex_unlock(&atm_dev_mutex);
1da177e4 127 return dev;
656d98b0
RK
128
129out_fail:
130 kfree(dev);
131 dev = NULL;
132 goto out;
1da177e4 133}
07b54c9a 134EXPORT_SYMBOL(atm_dev_register);
1da177e4
LT
135
136void atm_dev_deregister(struct atm_dev *dev)
137{
64bf69dd
SG
138 BUG_ON(test_bit(ATM_DF_REMOVED, &dev->flags));
139 set_bit(ATM_DF_REMOVED, &dev->flags);
140
141 /*
f7d57453
YH
142 * if we remove current device from atm_devs list, new device
143 * with same number can appear, such we need deregister proc,
64bf69dd
SG
144 * release async all vccs and remove them from vccs list too
145 */
57b47a53 146 mutex_lock(&atm_dev_mutex);
1da177e4 147 list_del(&dev->dev_list);
57b47a53 148 mutex_unlock(&atm_dev_mutex);
1da177e4 149
64bf69dd 150 atm_dev_release_vccs(dev);
656d98b0 151 atm_unregister_sysfs(dev);
64bf69dd 152 atm_proc_dev_deregister(dev);
1da177e4 153
64bf69dd 154 atm_dev_put(dev);
1da177e4 155}
07b54c9a 156EXPORT_SYMBOL(atm_dev_deregister);
1da177e4
LT
157
158static void copy_aal_stats(struct k_atm_aal_stats *from,
159 struct atm_aal_stats *to)
160{
161#define __HANDLE_ITEM(i) to->i = atomic_read(&from->i)
162 __AAL_STAT_ITEMS
163#undef __HANDLE_ITEM
164}
165
1da177e4
LT
166static void subtract_aal_stats(struct k_atm_aal_stats *from,
167 struct atm_aal_stats *to)
168{
169#define __HANDLE_ITEM(i) atomic_sub(to->i, &from->i)
170 __AAL_STAT_ITEMS
171#undef __HANDLE_ITEM
172}
173
07b54c9a
JP
174static int fetch_stats(struct atm_dev *dev, struct atm_dev_stats __user *arg,
175 int zero)
1da177e4
LT
176{
177 struct atm_dev_stats tmp;
178 int error = 0;
179
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);
183 if (arg)
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);
189 }
190 return error ? -EFAULT : 0;
191}
192
8865c418 193int atm_dev_ioctl(unsigned int cmd, void __user *arg, int compat)
1da177e4
LT
194{
195 void __user *buf;
196 int error, len, number, size = 0;
197 struct atm_dev *dev;
198 struct list_head *p;
199 int *tmp_buf, *tmp_p;
8865c418
DW
200 int __user *sioc_len;
201 int __user *iobuf_len;
202
203#ifndef CONFIG_COMPAT
204 compat = 0; /* Just so the compiler _knows_ */
205#endif
206
1da177e4 207 switch (cmd) {
07b54c9a
JP
208 case ATM_GETNAMES:
209 if (compat) {
8865c418 210#ifdef CONFIG_COMPAT
07b54c9a
JP
211 struct compat_atm_iobuf __user *ciobuf = arg;
212 compat_uptr_t cbuf;
213 iobuf_len = &ciobuf->length;
214 if (get_user(cbuf, &ciobuf->buffer))
215 return -EFAULT;
216 buf = compat_ptr(cbuf);
8865c418 217#endif
07b54c9a
JP
218 } else {
219 struct atm_iobuf __user *iobuf = arg;
220 iobuf_len = &iobuf->length;
221 if (get_user(buf, &iobuf->buffer))
1da177e4 222 return -EFAULT;
07b54c9a
JP
223 }
224 if (get_user(len, iobuf_len))
225 return -EFAULT;
226 mutex_lock(&atm_dev_mutex);
227 list_for_each(p, &atm_devs)
228 size += sizeof(int);
229 if (size > len) {
57b47a53 230 mutex_unlock(&atm_dev_mutex);
07b54c9a
JP
231 return -E2BIG;
232 }
233 tmp_buf = kmalloc(size, GFP_ATOMIC);
234 if (!tmp_buf) {
235 mutex_unlock(&atm_dev_mutex);
236 return -ENOMEM;
237 }
238 tmp_p = tmp_buf;
239 list_for_each(p, &atm_devs) {
240 dev = list_entry(p, struct atm_dev, dev_list);
241 *tmp_p++ = dev->number;
242 }
243 mutex_unlock(&atm_dev_mutex);
244 error = ((copy_to_user(buf, tmp_buf, size)) ||
245 put_user(size, iobuf_len))
246 ? -EFAULT : 0;
247 kfree(tmp_buf);
248 return error;
249 default:
250 break;
1da177e4
LT
251 }
252
8865c418
DW
253 if (compat) {
254#ifdef CONFIG_COMPAT
255 struct compat_atmif_sioc __user *csioc = arg;
256 compat_uptr_t carg;
257
258 sioc_len = &csioc->length;
259 if (get_user(carg, &csioc->arg))
260 return -EFAULT;
261 buf = compat_ptr(carg);
262
263 if (get_user(len, &csioc->length))
264 return -EFAULT;
265 if (get_user(number, &csioc->number))
266 return -EFAULT;
267#endif
268 } else {
269 struct atmif_sioc __user *sioc = arg;
270
271 sioc_len = &sioc->length;
272 if (get_user(buf, &sioc->arg))
273 return -EFAULT;
274 if (get_user(len, &sioc->length))
275 return -EFAULT;
276 if (get_user(number, &sioc->number))
277 return -EFAULT;
278 }
07b54c9a
JP
279
280 dev = try_then_request_module(atm_dev_lookup(number), "atm-device-%d",
281 number);
282 if (!dev)
1da177e4 283 return -ENODEV;
f7d57453 284
1da177e4 285 switch (cmd) {
07b54c9a
JP
286 case ATM_GETTYPE:
287 size = strlen(dev->type) + 1;
288 if (copy_to_user(buf, dev->type, size)) {
289 error = -EFAULT;
290 goto done;
291 }
292 break;
293 case ATM_GETESI:
294 size = ESI_LEN;
295 if (copy_to_user(buf, dev->esi, size)) {
296 error = -EFAULT;
297 goto done;
298 }
299 break;
300 case ATM_SETESI:
301 {
302 int i;
303
304 for (i = 0; i < ESI_LEN; i++)
305 if (dev->esi[i]) {
306 error = -EEXIST;
1da177e4
LT
307 goto done;
308 }
07b54c9a
JP
309 }
310 /* fall through */
311 case ATM_SETESIF:
312 {
313 unsigned char esi[ESI_LEN];
314
315 if (!capable(CAP_NET_ADMIN)) {
316 error = -EPERM;
317 goto done;
318 }
319 if (copy_from_user(esi, buf, ESI_LEN)) {
320 error = -EFAULT;
321 goto done;
322 }
323 memcpy(dev->esi, esi, ESI_LEN);
324 error = ESI_LEN;
325 goto done;
326 }
327 case ATM_GETSTATZ:
328 if (!capable(CAP_NET_ADMIN)) {
329 error = -EPERM;
330 goto done;
331 }
332 /* fall through */
333 case ATM_GETSTAT:
334 size = sizeof(struct atm_dev_stats);
335 error = fetch_stats(dev, buf, cmd == ATM_GETSTATZ);
336 if (error)
337 goto done;
338 break;
339 case ATM_GETCIRANGE:
340 size = sizeof(struct atm_cirange);
341 if (copy_to_user(buf, &dev->ci_range, size)) {
342 error = -EFAULT;
343 goto done;
344 }
345 break;
346 case ATM_GETLINKRATE:
347 size = sizeof(int);
348 if (copy_to_user(buf, &dev->link_rate, size)) {
349 error = -EFAULT;
350 goto done;
351 }
352 break;
353 case ATM_RSTADDR:
354 if (!capable(CAP_NET_ADMIN)) {
355 error = -EPERM;
356 goto done;
357 }
358 atm_reset_addr(dev, ATM_ADDR_LOCAL);
359 break;
360 case ATM_ADDADDR:
361 case ATM_DELADDR:
362 case ATM_ADDLECSADDR:
363 case ATM_DELLECSADDR:
364 {
365 struct sockaddr_atmsvc addr;
366
367 if (!capable(CAP_NET_ADMIN)) {
368 error = -EPERM;
369 goto done;
370 }
371
372 if (copy_from_user(&addr, buf, sizeof(addr))) {
373 error = -EFAULT;
374 goto done;
375 }
376 if (cmd == ATM_ADDADDR || cmd == ATM_ADDLECSADDR)
377 error = atm_add_addr(dev, &addr,
378 (cmd == ATM_ADDADDR ?
0f21ba7c 379 ATM_ADDR_LOCAL : ATM_ADDR_LECS));
07b54c9a
JP
380 else
381 error = atm_del_addr(dev, &addr,
382 (cmd == ATM_DELADDR ?
383 ATM_ADDR_LOCAL : ATM_ADDR_LECS));
384 goto done;
385 }
386 case ATM_GETADDR:
387 case ATM_GETLECSADDR:
388 error = atm_get_addr(dev, buf, len,
389 (cmd == ATM_GETADDR ?
390 ATM_ADDR_LOCAL : ATM_ADDR_LECS));
391 if (error < 0)
392 goto done;
393 size = error;
394 /* may return 0, but later on size == 0 means "don't
395 write the length" */
396 error = put_user(size, sioc_len) ? -EFAULT : 0;
397 goto done;
398 case ATM_SETLOOP:
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)) {
402 error = -EINVAL;
1da177e4 403 goto done;
07b54c9a
JP
404 }
405 /* fall through */
406 case ATM_SETCIRANGE:
407 case SONET_GETSTATZ:
408 case SONET_SETDIAG:
409 case SONET_CLRDIAG:
410 case SONET_SETFRAMING:
411 if (!capable(CAP_NET_ADMIN)) {
412 error = -EPERM;
413 goto done;
414 }
415 /* fall through */
416 default:
417 if (compat) {
418#ifdef CONFIG_COMPAT
419 if (!dev->ops->compat_ioctl) {
1da177e4
LT
420 error = -EINVAL;
421 goto done;
422 }
07b54c9a 423 size = dev->ops->compat_ioctl(dev, cmd, buf);
8865c418 424#endif
07b54c9a
JP
425 } else {
426 if (!dev->ops->ioctl) {
427 error = -EINVAL;
1da177e4
LT
428 goto done;
429 }
07b54c9a
JP
430 size = dev->ops->ioctl(dev, cmd, buf);
431 }
432 if (size < 0) {
433 error = (size == -ENOIOCTLCMD ? -EINVAL : size);
434 goto done;
435 }
1da177e4 436 }
f7d57453 437
1da177e4 438 if (size)
07b54c9a 439 error = put_user(size, sioc_len) ? -EFAULT : 0;
1da177e4
LT
440 else
441 error = 0;
442done:
443 atm_dev_put(dev);
444 return error;
445}
446
1da177e4
LT
447void *atm_dev_seq_start(struct seq_file *seq, loff_t *pos)
448{
f7d57453 449 mutex_lock(&atm_dev_mutex);
67de7924 450 return seq_list_start_head(&atm_devs, *pos);
1da177e4
LT
451}
452
453void atm_dev_seq_stop(struct seq_file *seq, void *v)
454{
f7d57453 455 mutex_unlock(&atm_dev_mutex);
1da177e4 456}
f7d57453 457
1da177e4
LT
458void *atm_dev_seq_next(struct seq_file *seq, void *v, loff_t *pos)
459{
67de7924 460 return seq_list_next(v, &atm_devs, pos);
1da177e4 461}