resources.c 9.9 KB
Newer Older
1
// SPDX-License-Identifier: GPL-2.0
L
Linus Torvalds 已提交
2 3 4 5 6 7 8 9 10
/* net/atm/resources.c - Statically allocated resources */

/* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */

/* Fixes
 * Arnaldo Carvalho de Melo <acme@conectiva.com.br>
 * 2002/01 - don't free the whole struct sock on sk->destruct time,
 * 	     use the default destruct function initialized by sock_init_data */

11
#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
L
Linus Torvalds 已提交
12 13 14 15 16 17 18 19

#include <linux/ctype.h>
#include <linux/string.h>
#include <linux/atmdev.h>
#include <linux/sonet.h>
#include <linux/kernel.h> /* for barrier */
#include <linux/module.h>
#include <linux/bitops.h>
20
#include <linux/capability.h>
L
Linus Torvalds 已提交
21
#include <linux/delay.h>
I
Ingo Molnar 已提交
22
#include <linux/mutex.h>
23
#include <linux/slab.h>
I
Ingo Molnar 已提交
24

L
Linus Torvalds 已提交
25 26 27 28 29 30 31 32
#include <net/sock.h>	 /* for struct sock */

#include "common.h"
#include "resources.h"
#include "addr.h"


LIST_HEAD(atm_devs);
I
Ingo Molnar 已提交
33
DEFINE_MUTEX(atm_dev_mutex);
L
Linus Torvalds 已提交
34 35 36 37 38

static struct atm_dev *__alloc_atm_dev(const char *type)
{
	struct atm_dev *dev;

39
	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
L
Linus Torvalds 已提交
40 41 42 43 44 45 46
	if (!dev)
		return NULL;
	dev->type = type;
	dev->signal = ATM_PHY_SIG_UNKNOWN;
	dev->link_rate = ATM_OC3_PCR;
	spin_lock_init(&dev->lock);
	INIT_LIST_HEAD(&dev->local);
47
	INIT_LIST_HEAD(&dev->lecs);
L
Linus Torvalds 已提交
48 49 50 51 52 53 54 55 56 57 58

	return dev;
}

static struct atm_dev *__atm_dev_lookup(int number)
{
	struct atm_dev *dev;
	struct list_head *p;

	list_for_each(p, &atm_devs) {
		dev = list_entry(p, struct atm_dev, dev_list);
59
		if (dev->number == number) {
L
Linus Torvalds 已提交
60 61 62 63 64 65 66 67 68 69 70
			atm_dev_hold(dev);
			return dev;
		}
	}
	return NULL;
}

struct atm_dev *atm_dev_lookup(int number)
{
	struct atm_dev *dev;

I
Ingo Molnar 已提交
71
	mutex_lock(&atm_dev_mutex);
L
Linus Torvalds 已提交
72
	dev = __atm_dev_lookup(number);
I
Ingo Molnar 已提交
73
	mutex_unlock(&atm_dev_mutex);
L
Linus Torvalds 已提交
74 75
	return dev;
}
76
EXPORT_SYMBOL(atm_dev_lookup);
77

78 79 80
struct atm_dev *atm_dev_register(const char *type, struct device *parent,
				 const struct atmdev_ops *ops, int number,
				 unsigned long *flags)
L
Linus Torvalds 已提交
81 82 83 84 85
{
	struct atm_dev *dev, *inuse;

	dev = __alloc_atm_dev(type);
	if (!dev) {
86
		pr_err("no space for dev %s\n", type);
L
Linus Torvalds 已提交
87 88
		return NULL;
	}
I
Ingo Molnar 已提交
89
	mutex_lock(&atm_dev_mutex);
L
Linus Torvalds 已提交
90
	if (number != -1) {
91 92
		inuse = __atm_dev_lookup(number);
		if (inuse) {
L
Linus Torvalds 已提交
93
			atm_dev_put(inuse);
I
Ingo Molnar 已提交
94
			mutex_unlock(&atm_dev_mutex);
95
			kfree(dev);
L
Linus Torvalds 已提交
96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112
			return NULL;
		}
		dev->number = number;
	} else {
		dev->number = 0;
		while ((inuse = __atm_dev_lookup(dev->number))) {
			atm_dev_put(inuse);
			dev->number++;
		}
	}

	dev->ops = ops;
	if (flags)
		dev->flags = *flags;
	else
		memset(&dev->flags, 0, sizeof(dev->flags));
	memset(&dev->stats, 0, sizeof(dev->stats));
113
	refcount_set(&dev->refcnt, 1);
L
Linus Torvalds 已提交
114 115

	if (atm_proc_dev_register(dev) < 0) {
116
		pr_err("atm_proc_dev_register failed for dev %s\n", type);
117 118 119
		goto out_fail;
	}

120
	if (atm_register_sysfs(dev, parent) < 0) {
121
		pr_err("atm_register_sysfs failed for dev %s\n", type);
122 123
		atm_proc_dev_deregister(dev);
		goto out_fail;
L
Linus Torvalds 已提交
124
	}
125

126
	list_add_tail(&dev->dev_list, &atm_devs);
L
Linus Torvalds 已提交
127

128 129
out:
	mutex_unlock(&atm_dev_mutex);
L
Linus Torvalds 已提交
130
	return dev;
131 132 133 134 135

out_fail:
	kfree(dev);
	dev = NULL;
	goto out;
L
Linus Torvalds 已提交
136
}
137
EXPORT_SYMBOL(atm_dev_register);
L
Linus Torvalds 已提交
138 139 140

void atm_dev_deregister(struct atm_dev *dev)
{
141 142 143 144
	BUG_ON(test_bit(ATM_DF_REMOVED, &dev->flags));
	set_bit(ATM_DF_REMOVED, &dev->flags);

	/*
145 146
	 * if we remove current device from atm_devs list, new device
	 * with same number can appear, such we need deregister proc,
147 148
	 * release async all vccs and remove them from vccs list too
	 */
I
Ingo Molnar 已提交
149
	mutex_lock(&atm_dev_mutex);
L
Linus Torvalds 已提交
150
	list_del(&dev->dev_list);
I
Ingo Molnar 已提交
151
	mutex_unlock(&atm_dev_mutex);
L
Linus Torvalds 已提交
152

153
	atm_dev_release_vccs(dev);
154
	atm_unregister_sysfs(dev);
155
	atm_proc_dev_deregister(dev);
L
Linus Torvalds 已提交
156

157
	atm_dev_put(dev);
L
Linus Torvalds 已提交
158
}
159
EXPORT_SYMBOL(atm_dev_deregister);
L
Linus Torvalds 已提交
160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176

static void copy_aal_stats(struct k_atm_aal_stats *from,
    struct atm_aal_stats *to)
{
#define __HANDLE_ITEM(i) to->i = atomic_read(&from->i)
	__AAL_STAT_ITEMS
#undef __HANDLE_ITEM
}

static void subtract_aal_stats(struct k_atm_aal_stats *from,
    struct atm_aal_stats *to)
{
#define __HANDLE_ITEM(i) atomic_sub(to->i, &from->i)
	__AAL_STAT_ITEMS
#undef __HANDLE_ITEM
}

177 178
static int fetch_stats(struct atm_dev *dev, struct atm_dev_stats __user *arg,
		       int zero)
L
Linus Torvalds 已提交
179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195
{
	struct atm_dev_stats tmp;
	int error = 0;

	copy_aal_stats(&dev->stats.aal0, &tmp.aal0);
	copy_aal_stats(&dev->stats.aal34, &tmp.aal34);
	copy_aal_stats(&dev->stats.aal5, &tmp.aal5);
	if (arg)
		error = copy_to_user(arg, &tmp, sizeof(tmp));
	if (zero && !error) {
		subtract_aal_stats(&dev->stats.aal0, &tmp.aal0);
		subtract_aal_stats(&dev->stats.aal34, &tmp.aal34);
		subtract_aal_stats(&dev->stats.aal5, &tmp.aal5);
	}
	return error ? -EFAULT : 0;
}

D
David Woodhouse 已提交
196
int atm_dev_ioctl(unsigned int cmd, void __user *arg, int compat)
L
Linus Torvalds 已提交
197 198 199 200 201 202
{
	void __user *buf;
	int error, len, number, size = 0;
	struct atm_dev *dev;
	struct list_head *p;
	int *tmp_buf, *tmp_p;
D
David Woodhouse 已提交
203 204 205
	int __user *sioc_len;
	int __user *iobuf_len;

L
Linus Torvalds 已提交
206
	switch (cmd) {
207
	case ATM_GETNAMES:
208
		if (IS_ENABLED(CONFIG_COMPAT) && compat) {
D
David Woodhouse 已提交
209
#ifdef CONFIG_COMPAT
210 211 212 213 214 215
			struct compat_atm_iobuf __user *ciobuf = arg;
			compat_uptr_t cbuf;
			iobuf_len = &ciobuf->length;
			if (get_user(cbuf, &ciobuf->buffer))
				return -EFAULT;
			buf = compat_ptr(cbuf);
D
David Woodhouse 已提交
216
#endif
217 218 219 220
		} else {
			struct atm_iobuf __user *iobuf = arg;
			iobuf_len = &iobuf->length;
			if (get_user(buf, &iobuf->buffer))
L
Linus Torvalds 已提交
221
				return -EFAULT;
222 223 224 225 226 227 228
		}
		if (get_user(len, iobuf_len))
			return -EFAULT;
		mutex_lock(&atm_dev_mutex);
		list_for_each(p, &atm_devs)
			size += sizeof(int);
		if (size > len) {
I
Ingo Molnar 已提交
229
			mutex_unlock(&atm_dev_mutex);
230 231 232 233 234 235 236 237 238 239 240 241 242 243 244 245 246 247 248 249
			return -E2BIG;
		}
		tmp_buf = kmalloc(size, GFP_ATOMIC);
		if (!tmp_buf) {
			mutex_unlock(&atm_dev_mutex);
			return -ENOMEM;
		}
		tmp_p = tmp_buf;
		list_for_each(p, &atm_devs) {
			dev = list_entry(p, struct atm_dev, dev_list);
			*tmp_p++ = dev->number;
		}
		mutex_unlock(&atm_dev_mutex);
		error = ((copy_to_user(buf, tmp_buf, size)) ||
			 put_user(size, iobuf_len))
			? -EFAULT : 0;
		kfree(tmp_buf);
		return error;
	default:
		break;
L
Linus Torvalds 已提交
250 251
	}

252
	if (IS_ENABLED(CONFIG_COMPAT) && compat) {
D
David Woodhouse 已提交
253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277
#ifdef CONFIG_COMPAT
		struct compat_atmif_sioc __user *csioc = arg;
		compat_uptr_t carg;

		sioc_len = &csioc->length;
		if (get_user(carg, &csioc->arg))
			return -EFAULT;
		buf = compat_ptr(carg);

		if (get_user(len, &csioc->length))
			return -EFAULT;
		if (get_user(number, &csioc->number))
			return -EFAULT;
#endif
	} else {
		struct atmif_sioc __user *sioc = arg;

		sioc_len = &sioc->length;
		if (get_user(buf, &sioc->arg))
			return -EFAULT;
		if (get_user(len, &sioc->length))
			return -EFAULT;
		if (get_user(number, &sioc->number))
			return -EFAULT;
	}
278 279 280 281

	dev = try_then_request_module(atm_dev_lookup(number), "atm-device-%d",
				      number);
	if (!dev)
L
Linus Torvalds 已提交
282
		return -ENODEV;
283

L
Linus Torvalds 已提交
284
	switch (cmd) {
285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305
	case ATM_GETTYPE:
		size = strlen(dev->type) + 1;
		if (copy_to_user(buf, dev->type, size)) {
			error = -EFAULT;
			goto done;
		}
		break;
	case ATM_GETESI:
		size = ESI_LEN;
		if (copy_to_user(buf, dev->esi, size)) {
			error = -EFAULT;
			goto done;
		}
		break;
	case ATM_SETESI:
	{
		int i;

		for (i = 0; i < ESI_LEN; i++)
			if (dev->esi[i]) {
				error = -EEXIST;
L
Linus Torvalds 已提交
306 307
				goto done;
			}
308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377
	}
	/* fall through */
	case ATM_SETESIF:
	{
		unsigned char esi[ESI_LEN];

		if (!capable(CAP_NET_ADMIN)) {
			error = -EPERM;
			goto done;
		}
		if (copy_from_user(esi, buf, ESI_LEN)) {
			error = -EFAULT;
			goto done;
		}
		memcpy(dev->esi, esi, ESI_LEN);
		error =  ESI_LEN;
		goto done;
	}
	case ATM_GETSTATZ:
		if (!capable(CAP_NET_ADMIN)) {
			error = -EPERM;
			goto done;
		}
		/* fall through */
	case ATM_GETSTAT:
		size = sizeof(struct atm_dev_stats);
		error = fetch_stats(dev, buf, cmd == ATM_GETSTATZ);
		if (error)
			goto done;
		break;
	case ATM_GETCIRANGE:
		size = sizeof(struct atm_cirange);
		if (copy_to_user(buf, &dev->ci_range, size)) {
			error = -EFAULT;
			goto done;
		}
		break;
	case ATM_GETLINKRATE:
		size = sizeof(int);
		if (copy_to_user(buf, &dev->link_rate, size)) {
			error = -EFAULT;
			goto done;
		}
		break;
	case ATM_RSTADDR:
		if (!capable(CAP_NET_ADMIN)) {
			error = -EPERM;
			goto done;
		}
		atm_reset_addr(dev, ATM_ADDR_LOCAL);
		break;
	case ATM_ADDADDR:
	case ATM_DELADDR:
	case ATM_ADDLECSADDR:
	case ATM_DELLECSADDR:
	{
		struct sockaddr_atmsvc addr;

		if (!capable(CAP_NET_ADMIN)) {
			error = -EPERM;
			goto done;
		}

		if (copy_from_user(&addr, buf, sizeof(addr))) {
			error = -EFAULT;
			goto done;
		}
		if (cmd == ATM_ADDADDR || cmd == ATM_ADDLECSADDR)
			error = atm_add_addr(dev, &addr,
					     (cmd == ATM_ADDADDR ?
378
					      ATM_ADDR_LOCAL : ATM_ADDR_LECS));
379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399 400 401
		else
			error = atm_del_addr(dev, &addr,
					     (cmd == ATM_DELADDR ?
					      ATM_ADDR_LOCAL : ATM_ADDR_LECS));
		goto done;
	}
	case ATM_GETADDR:
	case ATM_GETLECSADDR:
		error = atm_get_addr(dev, buf, len,
				     (cmd == ATM_GETADDR ?
				      ATM_ADDR_LOCAL : ATM_ADDR_LECS));
		if (error < 0)
			goto done;
		size = error;
		/* may return 0, but later on size == 0 means "don't
		   write the length" */
		error = put_user(size, sioc_len) ? -EFAULT : 0;
		goto done;
	case ATM_SETLOOP:
		if (__ATM_LM_XTRMT((int) (unsigned long) buf) &&
		    __ATM_LM_XTLOC((int) (unsigned long) buf) >
		    __ATM_LM_XTRMT((int) (unsigned long) buf)) {
			error = -EINVAL;
L
Linus Torvalds 已提交
402
			goto done;
403 404 405 406 407 408 409 410 411 412 413 414 415 416 417 418
		}
		/* fall through */
	case ATM_SETCIRANGE:
	case SONET_GETSTATZ:
	case SONET_SETDIAG:
	case SONET_CLRDIAG:
	case SONET_SETFRAMING:
		if (!capable(CAP_NET_ADMIN)) {
			error = -EPERM;
			goto done;
		}
		/* fall through */
	default:
		if (compat) {
#ifdef CONFIG_COMPAT
			if (!dev->ops->compat_ioctl) {
L
Linus Torvalds 已提交
419 420 421
				error = -EINVAL;
				goto done;
			}
422
			size = dev->ops->compat_ioctl(dev, cmd, buf);
D
David Woodhouse 已提交
423
#endif
424 425 426
		} else {
			if (!dev->ops->ioctl) {
				error = -EINVAL;
L
Linus Torvalds 已提交
427 428
				goto done;
			}
429 430 431
			size = dev->ops->ioctl(dev, cmd, buf);
		}
		if (size < 0) {
432
			error = (size == -ENOIOCTLCMD ? -ENOTTY : size);
433 434
			goto done;
		}
L
Linus Torvalds 已提交
435
	}
436

L
Linus Torvalds 已提交
437
	if (size)
438
		error = put_user(size, sioc_len) ? -EFAULT : 0;
L
Linus Torvalds 已提交
439 440 441 442 443 444 445 446 447
	else
		error = 0;
done:
	atm_dev_put(dev);
	return error;
}

void *atm_dev_seq_start(struct seq_file *seq, loff_t *pos)
{
448
	mutex_lock(&atm_dev_mutex);
L
Li Zefan 已提交
449
	return seq_list_start_head(&atm_devs, *pos);
L
Linus Torvalds 已提交
450 451 452 453
}

void atm_dev_seq_stop(struct seq_file *seq, void *v)
{
454
	mutex_unlock(&atm_dev_mutex);
L
Linus Torvalds 已提交
455
}
456

L
Linus Torvalds 已提交
457 458
void *atm_dev_seq_next(struct seq_file *seq, void *v, loff_t *pos)
{
L
Li Zefan 已提交
459
	return seq_list_next(v, &atm_devs, pos);
L
Linus Torvalds 已提交
460
}