Orange Pi5 kernel

Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards

3 Commits   0 Branches   0 Tags
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   1) // SPDX-License-Identifier: GPL-2.0-only
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   2) /* net/atm/common.c - ATM sockets (common part for PVC and SVC) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   3) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   4) /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   5) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   6) #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   7) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   8) #include <linux/module.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300   9) #include <linux/kmod.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  10) #include <linux/net.h>		/* struct socket, struct proto_ops */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  11) #include <linux/atm.h>		/* ATM stuff */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  12) #include <linux/atmdev.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  13) #include <linux/socket.h>	/* SOL_SOCKET */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  14) #include <linux/errno.h>	/* error codes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  15) #include <linux/capability.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  16) #include <linux/mm.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  17) #include <linux/sched/signal.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  18) #include <linux/time64.h>	/* 64-bit time for seconds */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  19) #include <linux/skbuff.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  20) #include <linux/bitops.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  21) #include <linux/init.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  22) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  23) #include <net/sock.h>		/* struct sock */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  24) #include <linux/uaccess.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  25) #include <linux/poll.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  26) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  27) #include <linux/atomic.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  28) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  29) #include "resources.h"		/* atm_find_dev */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  30) #include "common.h"		/* prototypes */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  31) #include "protocols.h"		/* atm_init_<transport> */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  32) #include "addr.h"		/* address registry */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  33) #include "signaling.h"		/* for WAITING and sigd_attach */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  34) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  35) struct hlist_head vcc_hash[VCC_HTABLE_SIZE];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  36) EXPORT_SYMBOL(vcc_hash);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  37) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  38) DEFINE_RWLOCK(vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  39) EXPORT_SYMBOL(vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  40) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  41) static ATOMIC_NOTIFIER_HEAD(atm_dev_notify_chain);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  42) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  43) static void __vcc_insert_socket(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  44) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  45) 	struct atm_vcc *vcc = atm_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  46) 	struct hlist_head *head = &vcc_hash[vcc->vci & (VCC_HTABLE_SIZE - 1)];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  47) 	sk->sk_hash = vcc->vci & (VCC_HTABLE_SIZE - 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  48) 	sk_add_node(sk, head);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  50) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  51) void vcc_insert_socket(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  52) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  53) 	write_lock_irq(&vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  54) 	__vcc_insert_socket(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  55) 	write_unlock_irq(&vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  56) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  57) EXPORT_SYMBOL(vcc_insert_socket);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  58) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  59) static void vcc_remove_socket(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  60) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  61) 	write_lock_irq(&vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  62) 	sk_del_node_init(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  63) 	write_unlock_irq(&vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  64) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  65) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  66) static bool vcc_tx_ready(struct atm_vcc *vcc, unsigned int size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  67) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  68) 	struct sock *sk = sk_atm(vcc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  69) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  70) 	if (sk_wmem_alloc_get(sk) && !atm_may_send(vcc, size)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  71) 		pr_debug("Sorry: wmem_alloc = %d, size = %d, sndbuf = %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  72) 			 sk_wmem_alloc_get(sk), size, sk->sk_sndbuf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  73) 		return false;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  74) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  75) 	return true;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  77) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  78) static void vcc_sock_destruct(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  79) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  80) 	if (atomic_read(&sk->sk_rmem_alloc))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  81) 		printk(KERN_DEBUG "%s: rmem leakage (%d bytes) detected.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  82) 		       __func__, atomic_read(&sk->sk_rmem_alloc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  83) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  84) 	if (refcount_read(&sk->sk_wmem_alloc))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  85) 		printk(KERN_DEBUG "%s: wmem leakage (%d bytes) detected.\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  86) 		       __func__, refcount_read(&sk->sk_wmem_alloc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  87) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  88) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  89) static void vcc_def_wakeup(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  90) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  91) 	struct socket_wq *wq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  92) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  93) 	rcu_read_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  94) 	wq = rcu_dereference(sk->sk_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  95) 	if (skwq_has_sleeper(wq))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  96) 		wake_up(&wq->wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  97) 	rcu_read_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  98) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300  99) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) static inline int vcc_writable(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) 	struct atm_vcc *vcc = atm_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) 	return (vcc->qos.txtp.max_sdu +
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105) 		refcount_read(&sk->sk_wmem_alloc)) <= sk->sk_sndbuf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) static void vcc_write_space(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) 	struct socket_wq *wq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) 	rcu_read_lock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) 	if (vcc_writable(sk)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) 		wq = rcu_dereference(sk->sk_wq);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) 		if (skwq_has_sleeper(wq))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) 			wake_up_interruptible(&wq->wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119) 		sk_wake_async(sk, SOCK_WAKE_SPACE, POLL_OUT);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) 	rcu_read_unlock();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) static void vcc_release_cb(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127) 	struct atm_vcc *vcc = atm_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) 	if (vcc->release_cb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) 		vcc->release_cb(vcc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) static struct proto vcc_proto = {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) 	.name	  = "VCC",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) 	.owner	  = THIS_MODULE,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136) 	.obj_size = sizeof(struct atm_vcc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) 	.release_cb = vcc_release_cb,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) };
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 139) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 140) int vcc_create(struct net *net, struct socket *sock, int protocol, int family, int kern)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 141) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 142) 	struct sock *sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 143) 	struct atm_vcc *vcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 144) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 145) 	sock->sk = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 146) 	if (sock->type == SOCK_STREAM)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 147) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 148) 	sk = sk_alloc(net, family, GFP_KERNEL, &vcc_proto, kern);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 149) 	if (!sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 150) 		return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 151) 	sock_init_data(sock, sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 152) 	sk->sk_state_change = vcc_def_wakeup;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 153) 	sk->sk_write_space = vcc_write_space;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 154) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 155) 	vcc = atm_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 156) 	vcc->dev = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 157) 	memset(&vcc->local, 0, sizeof(struct sockaddr_atmsvc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 158) 	memset(&vcc->remote, 0, sizeof(struct sockaddr_atmsvc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 159) 	vcc->qos.txtp.max_sdu = 1 << 16; /* for meta VCs */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 160) 	refcount_set(&sk->sk_wmem_alloc, 1);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 161) 	atomic_set(&sk->sk_rmem_alloc, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 162) 	vcc->push = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 163) 	vcc->pop = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 164) 	vcc->owner = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 165) 	vcc->push_oam = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 166) 	vcc->release_cb = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 167) 	vcc->vpi = vcc->vci = 0; /* no VCI/VPI yet */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 168) 	vcc->atm_options = vcc->aal_options = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 169) 	sk->sk_destruct = vcc_sock_destruct;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 170) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 171) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 172) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 173) static void vcc_destroy_socket(struct sock *sk)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 174) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 175) 	struct atm_vcc *vcc = atm_sk(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 176) 	struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 177) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 178) 	set_bit(ATM_VF_CLOSE, &vcc->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 179) 	clear_bit(ATM_VF_READY, &vcc->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 180) 	if (vcc->dev && vcc->dev->ops->close)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 181) 		vcc->dev->ops->close(vcc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 182) 	if (vcc->push)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 183) 		vcc->push(vcc, NULL); /* atmarpd has no push */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 184) 	module_put(vcc->owner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 185) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 186) 	while ((skb = skb_dequeue(&sk->sk_receive_queue)) != NULL) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 187) 		atm_return(vcc, skb->truesize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 188) 		kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 189) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 190) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 191) 	if (vcc->dev && vcc->dev->ops->owner) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 192) 		module_put(vcc->dev->ops->owner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 193) 		atm_dev_put(vcc->dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 194) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 195) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 196) 	vcc_remove_socket(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 197) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 198) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 199) int vcc_release(struct socket *sock)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 200) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 201) 	struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 202) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 203) 	if (sk) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 204) 		lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 205) 		vcc_destroy_socket(sock->sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 206) 		release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 207) 		sock_put(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 208) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 209) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 210) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 211) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 212) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 213) void vcc_release_async(struct atm_vcc *vcc, int reply)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 214) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 215) 	struct sock *sk = sk_atm(vcc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 216) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 217) 	set_bit(ATM_VF_CLOSE, &vcc->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 218) 	sk->sk_shutdown |= RCV_SHUTDOWN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 219) 	sk->sk_err = -reply;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 220) 	clear_bit(ATM_VF_WAITING, &vcc->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 221) 	sk->sk_state_change(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 222) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 223) EXPORT_SYMBOL(vcc_release_async);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 224) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 225) void vcc_process_recv_queue(struct atm_vcc *vcc)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 226) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 227) 	struct sk_buff_head queue, *rq;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 228) 	struct sk_buff *skb, *tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 229) 	unsigned long flags;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 230) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 231) 	__skb_queue_head_init(&queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 232) 	rq = &sk_atm(vcc)->sk_receive_queue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 233) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 234) 	spin_lock_irqsave(&rq->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 235) 	skb_queue_splice_init(rq, &queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 236) 	spin_unlock_irqrestore(&rq->lock, flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 237) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 238) 	skb_queue_walk_safe(&queue, skb, tmp) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 239) 		__skb_unlink(skb, &queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 240) 		vcc->push(vcc, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 241) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 242) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 243) EXPORT_SYMBOL(vcc_process_recv_queue);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 244) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 245) void atm_dev_signal_change(struct atm_dev *dev, char signal)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 246) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 247) 	pr_debug("%s signal=%d dev=%p number=%d dev->signal=%d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 248) 		__func__, signal, dev, dev->number, dev->signal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 249) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 250) 	/* atm driver sending invalid signal */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 251) 	WARN_ON(signal < ATM_PHY_SIG_LOST || signal > ATM_PHY_SIG_FOUND);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 252) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 253) 	if (dev->signal == signal)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 254) 		return; /* no change */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 255) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 256) 	dev->signal = signal;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 257) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 258) 	atomic_notifier_call_chain(&atm_dev_notify_chain, signal, dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 259) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 260) EXPORT_SYMBOL(atm_dev_signal_change);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 261) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 262) void atm_dev_release_vccs(struct atm_dev *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 263) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 264) 	int i;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 265) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 266) 	write_lock_irq(&vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 267) 	for (i = 0; i < VCC_HTABLE_SIZE; i++) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 268) 		struct hlist_head *head = &vcc_hash[i];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 269) 		struct hlist_node *tmp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 270) 		struct sock *s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 271) 		struct atm_vcc *vcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 272) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 273) 		sk_for_each_safe(s, tmp, head) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 274) 			vcc = atm_sk(s);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 275) 			if (vcc->dev == dev) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 276) 				vcc_release_async(vcc, -EPIPE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 277) 				sk_del_node_init(s);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 278) 			}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 279) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 280) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 281) 	write_unlock_irq(&vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 282) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 283) EXPORT_SYMBOL(atm_dev_release_vccs);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 284) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 285) static int adjust_tp(struct atm_trafprm *tp, unsigned char aal)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 286) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 287) 	int max_sdu;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 288) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 289) 	if (!tp->traffic_class)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 290) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 291) 	switch (aal) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 292) 	case ATM_AAL0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 293) 		max_sdu = ATM_CELL_SIZE-1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 294) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 295) 	case ATM_AAL34:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 296) 		max_sdu = ATM_MAX_AAL34_PDU;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 297) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 298) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 299) 		pr_warn("AAL problems ... (%d)\n", aal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 300) 		fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 301) 	case ATM_AAL5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 302) 		max_sdu = ATM_MAX_AAL5_PDU;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 303) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 304) 	if (!tp->max_sdu)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 305) 		tp->max_sdu = max_sdu;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 306) 	else if (tp->max_sdu > max_sdu)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 307) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 308) 	if (!tp->max_cdv)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 309) 		tp->max_cdv = ATM_MAX_CDV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 310) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 311) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 312) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 313) static int check_ci(const struct atm_vcc *vcc, short vpi, int vci)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 314) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 315) 	struct hlist_head *head = &vcc_hash[vci & (VCC_HTABLE_SIZE - 1)];
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 316) 	struct sock *s;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 317) 	struct atm_vcc *walk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 318) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 319) 	sk_for_each(s, head) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 320) 		walk = atm_sk(s);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 321) 		if (walk->dev != vcc->dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 322) 			continue;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 323) 		if (test_bit(ATM_VF_ADDR, &walk->flags) && walk->vpi == vpi &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 324) 		    walk->vci == vci && ((walk->qos.txtp.traffic_class !=
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 325) 		    ATM_NONE && vcc->qos.txtp.traffic_class != ATM_NONE) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 326) 		    (walk->qos.rxtp.traffic_class != ATM_NONE &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 327) 		    vcc->qos.rxtp.traffic_class != ATM_NONE)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 328) 			return -EADDRINUSE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 329) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 330) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 331) 	/* allow VCCs with same VPI/VCI iff they don't collide on
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 332) 	   TX/RX (but we may refuse such sharing for other reasons,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 333) 	   e.g. if protocol requires to have both channels) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 334) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 335) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 336) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 337) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 338) static int find_ci(const struct atm_vcc *vcc, short *vpi, int *vci)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 339) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 340) 	static short p;        /* poor man's per-device cache */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 341) 	static int c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 342) 	short old_p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 343) 	int old_c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 344) 	int err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 345) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 346) 	if (*vpi != ATM_VPI_ANY && *vci != ATM_VCI_ANY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 347) 		err = check_ci(vcc, *vpi, *vci);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 348) 		return err;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 349) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 350) 	/* last scan may have left values out of bounds for current device */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 351) 	if (*vpi != ATM_VPI_ANY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 352) 		p = *vpi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 353) 	else if (p >= 1 << vcc->dev->ci_range.vpi_bits)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 354) 		p = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 355) 	if (*vci != ATM_VCI_ANY)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 356) 		c = *vci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 357) 	else if (c < ATM_NOT_RSV_VCI || c >= 1 << vcc->dev->ci_range.vci_bits)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 358) 			c = ATM_NOT_RSV_VCI;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 359) 	old_p = p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 360) 	old_c = c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 361) 	do {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 362) 		if (!check_ci(vcc, p, c)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 363) 			*vpi = p;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 364) 			*vci = c;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 365) 			return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 366) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 367) 		if (*vci == ATM_VCI_ANY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 368) 			c++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 369) 			if (c >= 1 << vcc->dev->ci_range.vci_bits)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 370) 				c = ATM_NOT_RSV_VCI;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 371) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 372) 		if ((c == ATM_NOT_RSV_VCI || *vci != ATM_VCI_ANY) &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 373) 		    *vpi == ATM_VPI_ANY) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 374) 			p++;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 375) 			if (p >= 1 << vcc->dev->ci_range.vpi_bits)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 376) 				p = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 377) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 378) 	} while (old_p != p || old_c != c);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 379) 	return -EADDRINUSE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 380) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 381) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 382) static int __vcc_connect(struct atm_vcc *vcc, struct atm_dev *dev, short vpi,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 383) 			 int vci)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 384) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 385) 	struct sock *sk = sk_atm(vcc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 386) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 387) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 388) 	if ((vpi != ATM_VPI_UNSPEC && vpi != ATM_VPI_ANY &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 389) 	    vpi >> dev->ci_range.vpi_bits) || (vci != ATM_VCI_UNSPEC &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 390) 	    vci != ATM_VCI_ANY && vci >> dev->ci_range.vci_bits))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 391) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 392) 	if (vci > 0 && vci < ATM_NOT_RSV_VCI && !capable(CAP_NET_BIND_SERVICE))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 393) 		return -EPERM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 394) 	error = -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 395) 	if (!try_module_get(dev->ops->owner))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 396) 		return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 397) 	vcc->dev = dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 398) 	write_lock_irq(&vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 399) 	if (test_bit(ATM_DF_REMOVED, &dev->flags) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 400) 	    (error = find_ci(vcc, &vpi, &vci))) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 401) 		write_unlock_irq(&vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 402) 		goto fail_module_put;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 403) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 404) 	vcc->vpi = vpi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 405) 	vcc->vci = vci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 406) 	__vcc_insert_socket(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 407) 	write_unlock_irq(&vcc_sklist_lock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 408) 	switch (vcc->qos.aal) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 409) 	case ATM_AAL0:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 410) 		error = atm_init_aal0(vcc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 411) 		vcc->stats = &dev->stats.aal0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 412) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 413) 	case ATM_AAL34:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 414) 		error = atm_init_aal34(vcc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 415) 		vcc->stats = &dev->stats.aal34;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 416) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 417) 	case ATM_NO_AAL:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 418) 		/* ATM_AAL5 is also used in the "0 for default" case */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 419) 		vcc->qos.aal = ATM_AAL5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 420) 		fallthrough;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 421) 	case ATM_AAL5:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 422) 		error = atm_init_aal5(vcc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 423) 		vcc->stats = &dev->stats.aal5;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 424) 		break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 425) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 426) 		error = -EPROTOTYPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 427) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 428) 	if (!error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 429) 		error = adjust_tp(&vcc->qos.txtp, vcc->qos.aal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 430) 	if (!error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 431) 		error = adjust_tp(&vcc->qos.rxtp, vcc->qos.aal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 432) 	if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 433) 		goto fail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 434) 	pr_debug("VCC %d.%d, AAL %d\n", vpi, vci, vcc->qos.aal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 435) 	pr_debug("  TX: %d, PCR %d..%d, SDU %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 436) 		 vcc->qos.txtp.traffic_class,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 437) 		 vcc->qos.txtp.min_pcr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 438) 		 vcc->qos.txtp.max_pcr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 439) 		 vcc->qos.txtp.max_sdu);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 440) 	pr_debug("  RX: %d, PCR %d..%d, SDU %d\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 441) 		 vcc->qos.rxtp.traffic_class,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 442) 		 vcc->qos.rxtp.min_pcr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 443) 		 vcc->qos.rxtp.max_pcr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 444) 		 vcc->qos.rxtp.max_sdu);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 445) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 446) 	if (dev->ops->open) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 447) 		error = dev->ops->open(vcc);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 448) 		if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 449) 			goto fail;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 450) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 451) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 452) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 453) fail:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 454) 	vcc_remove_socket(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 455) fail_module_put:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 456) 	module_put(dev->ops->owner);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 457) 	/* ensure we get dev module ref count correct */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 458) 	vcc->dev = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 459) 	return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 460) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 461) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 462) int vcc_connect(struct socket *sock, int itf, short vpi, int vci)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 463) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 464) 	struct atm_dev *dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 465) 	struct atm_vcc *vcc = ATM_SD(sock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 466) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 467) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 468) 	pr_debug("(vpi %d, vci %d)\n", vpi, vci);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 469) 	if (sock->state == SS_CONNECTED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 470) 		return -EISCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 471) 	if (sock->state != SS_UNCONNECTED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 472) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 473) 	if (!(vpi || vci))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 474) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 475) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 476) 	if (vpi != ATM_VPI_UNSPEC && vci != ATM_VCI_UNSPEC)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 477) 		clear_bit(ATM_VF_PARTIAL, &vcc->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 478) 	else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 479) 		if (test_bit(ATM_VF_PARTIAL, &vcc->flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 480) 			return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 481) 	pr_debug("(TX: cl %d,bw %d-%d,sdu %d; "
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 482) 		 "RX: cl %d,bw %d-%d,sdu %d,AAL %s%d)\n",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 483) 		 vcc->qos.txtp.traffic_class, vcc->qos.txtp.min_pcr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 484) 		 vcc->qos.txtp.max_pcr, vcc->qos.txtp.max_sdu,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 485) 		 vcc->qos.rxtp.traffic_class, vcc->qos.rxtp.min_pcr,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 486) 		 vcc->qos.rxtp.max_pcr, vcc->qos.rxtp.max_sdu,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 487) 		 vcc->qos.aal == ATM_AAL5 ? "" :
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 488) 		 vcc->qos.aal == ATM_AAL0 ? "" : " ??? code ",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 489) 		 vcc->qos.aal == ATM_AAL0 ? 0 : vcc->qos.aal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 490) 	if (!test_bit(ATM_VF_HASQOS, &vcc->flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 491) 		return -EBADFD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 492) 	if (vcc->qos.txtp.traffic_class == ATM_ANYCLASS ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 493) 	    vcc->qos.rxtp.traffic_class == ATM_ANYCLASS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 494) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 495) 	if (likely(itf != ATM_ITF_ANY)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 496) 		dev = try_then_request_module(atm_dev_lookup(itf),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 497) 					      "atm-device-%d", itf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 498) 	} else {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 499) 		dev = NULL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 500) 		mutex_lock(&atm_dev_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 501) 		if (!list_empty(&atm_devs)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 502) 			dev = list_entry(atm_devs.next,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 503) 					 struct atm_dev, dev_list);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 504) 			atm_dev_hold(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 505) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 506) 		mutex_unlock(&atm_dev_mutex);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 507) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 508) 	if (!dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 509) 		return -ENODEV;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 510) 	error = __vcc_connect(vcc, dev, vpi, vci);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 511) 	if (error) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 512) 		atm_dev_put(dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 513) 		return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 514) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 515) 	if (vpi == ATM_VPI_UNSPEC || vci == ATM_VCI_UNSPEC)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 516) 		set_bit(ATM_VF_PARTIAL, &vcc->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 517) 	if (test_bit(ATM_VF_READY, &ATM_SD(sock)->flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 518) 		sock->state = SS_CONNECTED;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 519) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 520) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 521) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 522) int vcc_recvmsg(struct socket *sock, struct msghdr *msg, size_t size,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 523) 		int flags)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 524) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 525) 	struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 526) 	struct atm_vcc *vcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 527) 	struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 528) 	int copied, error = -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 529) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 530) 	if (sock->state != SS_CONNECTED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 531) 		return -ENOTCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 532) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 533) 	/* only handle MSG_DONTWAIT and MSG_PEEK */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 534) 	if (flags & ~(MSG_DONTWAIT | MSG_PEEK))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 535) 		return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 536) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 537) 	vcc = ATM_SD(sock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 538) 	if (test_bit(ATM_VF_RELEASED, &vcc->flags) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 539) 	    test_bit(ATM_VF_CLOSE, &vcc->flags) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 540) 	    !test_bit(ATM_VF_READY, &vcc->flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 541) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 542) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 543) 	skb = skb_recv_datagram(sk, flags, flags & MSG_DONTWAIT, &error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 544) 	if (!skb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 545) 		return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 546) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 547) 	copied = skb->len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 548) 	if (copied > size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 549) 		copied = size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 550) 		msg->msg_flags |= MSG_TRUNC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 551) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 552) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 553) 	error = skb_copy_datagram_msg(skb, 0, msg, copied);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 554) 	if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 555) 		return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 556) 	sock_recv_ts_and_drops(msg, sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 557) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 558) 	if (!(flags & MSG_PEEK)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 559) 		pr_debug("%d -= %d\n", atomic_read(&sk->sk_rmem_alloc),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 560) 			 skb->truesize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 561) 		atm_return(vcc, skb->truesize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 562) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 563) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 564) 	skb_free_datagram(sk, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 565) 	return copied;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 566) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 567) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 568) int vcc_sendmsg(struct socket *sock, struct msghdr *m, size_t size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 569) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 570) 	struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 571) 	DEFINE_WAIT(wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 572) 	struct atm_vcc *vcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 573) 	struct sk_buff *skb;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 574) 	int eff, error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 575) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 576) 	lock_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 577) 	if (sock->state != SS_CONNECTED) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 578) 		error = -ENOTCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 579) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 580) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 581) 	if (m->msg_name) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 582) 		error = -EISCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 583) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 584) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 585) 	vcc = ATM_SD(sock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 586) 	if (test_bit(ATM_VF_RELEASED, &vcc->flags) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 587) 	    test_bit(ATM_VF_CLOSE, &vcc->flags) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 588) 	    !test_bit(ATM_VF_READY, &vcc->flags)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 589) 		error = -EPIPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 590) 		send_sig(SIGPIPE, current, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 591) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 592) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 593) 	if (!size) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 594) 		error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 595) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 596) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 597) 	if (size > vcc->qos.txtp.max_sdu) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 598) 		error = -EMSGSIZE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 599) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 600) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 601) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 602) 	eff = (size+3) & ~3; /* align to word boundary */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 603) 	prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 604) 	error = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 605) 	while (!vcc_tx_ready(vcc, eff)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 606) 		if (m->msg_flags & MSG_DONTWAIT) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 607) 			error = -EAGAIN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 608) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 609) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 610) 		schedule();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 611) 		if (signal_pending(current)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 612) 			error = -ERESTARTSYS;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 613) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 614) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 615) 		if (test_bit(ATM_VF_RELEASED, &vcc->flags) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 616) 		    test_bit(ATM_VF_CLOSE, &vcc->flags) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 617) 		    !test_bit(ATM_VF_READY, &vcc->flags)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 618) 			error = -EPIPE;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 619) 			send_sig(SIGPIPE, current, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 620) 			break;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 621) 		}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 622) 		prepare_to_wait(sk_sleep(sk), &wait, TASK_INTERRUPTIBLE);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 623) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 624) 	finish_wait(sk_sleep(sk), &wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 625) 	if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 626) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 627) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 628) 	skb = alloc_skb(eff, GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 629) 	if (!skb) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 630) 		error = -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 631) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 632) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 633) 	pr_debug("%d += %d\n", sk_wmem_alloc_get(sk), skb->truesize);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 634) 	atm_account_tx(vcc, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 635) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 636) 	skb->dev = NULL; /* for paths shared with net_device interfaces */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 637) 	if (!copy_from_iter_full(skb_put(skb, size), size, &m->msg_iter)) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 638) 		kfree_skb(skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 639) 		error = -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 640) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 641) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 642) 	if (eff != size)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 643) 		memset(skb->data + size, 0, eff-size);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 644) 	error = vcc->dev->ops->send(vcc, skb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 645) 	error = error ? error : size;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 646) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 647) 	release_sock(sk);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 648) 	return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 649) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 650) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 651) __poll_t vcc_poll(struct file *file, struct socket *sock, poll_table *wait)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 652) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 653) 	struct sock *sk = sock->sk;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 654) 	struct atm_vcc *vcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 655) 	__poll_t mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 656) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 657) 	sock_poll_wait(file, sock, wait);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 658) 	mask = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 659) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 660) 	vcc = ATM_SD(sock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 661) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 662) 	/* exceptional events */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 663) 	if (sk->sk_err)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 664) 		mask = EPOLLERR;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 665) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 666) 	if (test_bit(ATM_VF_RELEASED, &vcc->flags) ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 667) 	    test_bit(ATM_VF_CLOSE, &vcc->flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 668) 		mask |= EPOLLHUP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 669) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 670) 	/* readable? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 671) 	if (!skb_queue_empty_lockless(&sk->sk_receive_queue))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 672) 		mask |= EPOLLIN | EPOLLRDNORM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 673) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 674) 	/* writable? */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 675) 	if (sock->state == SS_CONNECTING &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 676) 	    test_bit(ATM_VF_WAITING, &vcc->flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 677) 		return mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 678) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 679) 	if (vcc->qos.txtp.traffic_class != ATM_NONE &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 680) 	    vcc_writable(sk))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 681) 		mask |= EPOLLOUT | EPOLLWRNORM | EPOLLWRBAND;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 682) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 683) 	return mask;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 684) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 685) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 686) static int atm_change_qos(struct atm_vcc *vcc, struct atm_qos *qos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 687) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 688) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 689) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 690) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 691) 	 * Don't let the QoS change the already connected AAL type nor the
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 692) 	 * traffic class.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 693) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 694) 	if (qos->aal != vcc->qos.aal ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 695) 	    qos->rxtp.traffic_class != vcc->qos.rxtp.traffic_class ||
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 696) 	    qos->txtp.traffic_class != vcc->qos.txtp.traffic_class)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 697) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 698) 	error = adjust_tp(&qos->txtp, qos->aal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 699) 	if (!error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 700) 		error = adjust_tp(&qos->rxtp, qos->aal);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 701) 	if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 702) 		return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 703) 	if (!vcc->dev->ops->change_qos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 704) 		return -EOPNOTSUPP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 705) 	if (sk_atm(vcc)->sk_family == AF_ATMPVC)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 706) 		return vcc->dev->ops->change_qos(vcc, qos, ATM_MF_SET);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 707) 	return svc_change_qos(vcc, qos);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 708) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 709) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 710) static int check_tp(const struct atm_trafprm *tp)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 711) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 712) 	/* @@@ Should be merged with adjust_tp */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 713) 	if (!tp->traffic_class || tp->traffic_class == ATM_ANYCLASS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 714) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 715) 	if (tp->traffic_class != ATM_UBR && !tp->min_pcr && !tp->pcr &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 716) 	    !tp->max_pcr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 717) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 718) 	if (tp->min_pcr == ATM_MAX_PCR)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 719) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 720) 	if (tp->min_pcr && tp->max_pcr && tp->max_pcr != ATM_MAX_PCR &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 721) 	    tp->min_pcr > tp->max_pcr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 722) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 723) 	/*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 724) 	 * We allow pcr to be outside [min_pcr,max_pcr], because later
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 725) 	 * adjustment may still push it in the valid range.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 726) 	 */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 727) 	return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 728) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 729) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 730) static int check_qos(const struct atm_qos *qos)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 731) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 732) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 733) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 734) 	if (!qos->txtp.traffic_class && !qos->rxtp.traffic_class)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 735) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 736) 	if (qos->txtp.traffic_class != qos->rxtp.traffic_class &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 737) 	    qos->txtp.traffic_class && qos->rxtp.traffic_class &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 738) 	    qos->txtp.traffic_class != ATM_ANYCLASS &&
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 739) 	    qos->rxtp.traffic_class != ATM_ANYCLASS)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 740) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 741) 	error = check_tp(&qos->txtp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 742) 	if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 743) 		return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 744) 	return check_tp(&qos->rxtp);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 745) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 746) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 747) int vcc_setsockopt(struct socket *sock, int level, int optname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 748) 		   sockptr_t optval, unsigned int optlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 749) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 750) 	struct atm_vcc *vcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 751) 	unsigned long value;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 752) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 753) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 754) 	if (__SO_LEVEL_MATCH(optname, level) && optlen != __SO_SIZE(optname))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 755) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 756) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 757) 	vcc = ATM_SD(sock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 758) 	switch (optname) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 759) 	case SO_ATMQOS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 760) 	{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 761) 		struct atm_qos qos;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 762) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 763) 		if (copy_from_sockptr(&qos, optval, sizeof(qos)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 764) 			return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 765) 		error = check_qos(&qos);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 766) 		if (error)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 767) 			return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 768) 		if (sock->state == SS_CONNECTED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 769) 			return atm_change_qos(vcc, &qos);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 770) 		if (sock->state != SS_UNCONNECTED)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 771) 			return -EBADFD;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 772) 		vcc->qos = qos;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 773) 		set_bit(ATM_VF_HASQOS, &vcc->flags);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 774) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 775) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 776) 	case SO_SETCLP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 777) 		if (copy_from_sockptr(&value, optval, sizeof(value)))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 778) 			return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 779) 		if (value)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 780) 			vcc->atm_options |= ATM_ATMOPT_CLP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 781) 		else
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 782) 			vcc->atm_options &= ~ATM_ATMOPT_CLP;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 783) 		return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 784) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 785) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 786) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 787) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 788) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 789) int vcc_getsockopt(struct socket *sock, int level, int optname,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 790) 		   char __user *optval, int __user *optlen)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 791) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 792) 	struct atm_vcc *vcc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 793) 	int len;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 794) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 795) 	if (get_user(len, optlen))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 796) 		return -EFAULT;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 797) 	if (__SO_LEVEL_MATCH(optname, level) && len != __SO_SIZE(optname))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 798) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 799) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 800) 	vcc = ATM_SD(sock);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 801) 	switch (optname) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 802) 	case SO_ATMQOS:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 803) 		if (!test_bit(ATM_VF_HASQOS, &vcc->flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 804) 			return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 805) 		return copy_to_user(optval, &vcc->qos, sizeof(vcc->qos))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 806) 			? -EFAULT : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 807) 	case SO_SETCLP:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 808) 		return put_user(vcc->atm_options & ATM_ATMOPT_CLP ? 1 : 0,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 809) 				(unsigned long __user *)optval) ? -EFAULT : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 810) 	case SO_ATMPVC:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 811) 	{
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 812) 		struct sockaddr_atmpvc pvc;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 813) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 814) 		if (!vcc->dev || !test_bit(ATM_VF_ADDR, &vcc->flags))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 815) 			return -ENOTCONN;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 816) 		memset(&pvc, 0, sizeof(pvc));
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 817) 		pvc.sap_family = AF_ATMPVC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 818) 		pvc.sap_addr.itf = vcc->dev->number;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 819) 		pvc.sap_addr.vpi = vcc->vpi;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 820) 		pvc.sap_addr.vci = vcc->vci;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 821) 		return copy_to_user(optval, &pvc, sizeof(pvc)) ? -EFAULT : 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 822) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 823) 	default:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 824) 		return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 825) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 826) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 827) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 828) int register_atmdevice_notifier(struct notifier_block *nb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 829) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 830) 	return atomic_notifier_chain_register(&atm_dev_notify_chain, nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 831) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 832) EXPORT_SYMBOL_GPL(register_atmdevice_notifier);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 833) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 834) void unregister_atmdevice_notifier(struct notifier_block *nb)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 835) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 836) 	atomic_notifier_chain_unregister(&atm_dev_notify_chain, nb);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 837) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 838) EXPORT_SYMBOL_GPL(unregister_atmdevice_notifier);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 839) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 840) static int __init atm_init(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 841) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 842) 	int error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 843) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 844) 	error = proto_register(&vcc_proto, 0);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 845) 	if (error < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 846) 		goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 847) 	error = atmpvc_init();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 848) 	if (error < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 849) 		pr_err("atmpvc_init() failed with %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 850) 		goto out_unregister_vcc_proto;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 851) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 852) 	error = atmsvc_init();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 853) 	if (error < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 854) 		pr_err("atmsvc_init() failed with %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 855) 		goto out_atmpvc_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 856) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 857) 	error = atm_proc_init();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 858) 	if (error < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 859) 		pr_err("atm_proc_init() failed with %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 860) 		goto out_atmsvc_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 861) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 862) 	error = atm_sysfs_init();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 863) 	if (error < 0) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 864) 		pr_err("atm_sysfs_init() failed with %d\n", error);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 865) 		goto out_atmproc_exit;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 866) 	}
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 867) out:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 868) 	return error;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 869) out_atmproc_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 870) 	atm_proc_exit();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 871) out_atmsvc_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 872) 	atmsvc_exit();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 873) out_atmpvc_exit:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 874) 	atmsvc_exit();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 875) out_unregister_vcc_proto:
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 876) 	proto_unregister(&vcc_proto);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 877) 	goto out;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 878) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 879) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 880) static void __exit atm_exit(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 881) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 882) 	atm_proc_exit();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 883) 	atm_sysfs_exit();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 884) 	atmsvc_exit();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 885) 	atmpvc_exit();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 886) 	proto_unregister(&vcc_proto);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 887) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 888) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 889) subsys_initcall(atm_init);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 890) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 891) module_exit(atm_exit);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 892) 
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 893) MODULE_LICENSE("GPL");
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 894) MODULE_ALIAS_NETPROTO(PF_ATMPVC);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 895) MODULE_ALIAS_NETPROTO(PF_ATMSVC);