1 // SPDX-License-Identifier: GPL-2.0
2 /* net/atm/raw.c - Raw AAL0 and AAL5 transports */
3 
4 /* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
5 
6 #define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
7 
8 #include <linux/module.h>
9 #include <linux/atmdev.h>
10 #include <linux/capability.h>
11 #include <linux/kernel.h>
12 #include <linux/skbuff.h>
13 #include <linux/mm.h>
14 #include <linux/slab.h>
15 
16 #include "common.h"
17 #include "protocols.h"
18 
19 /*
20  * SKB == NULL indicates that the link is being closed
21  */
22 
atm_push_raw(struct atm_vcc * vcc,struct sk_buff * skb)23 static void atm_push_raw(struct atm_vcc *vcc, struct sk_buff *skb)
24 {
25 	if (skb) {
26 		struct sock *sk = sk_atm(vcc);
27 
28 		skb_queue_tail(&sk->sk_receive_queue, skb);
29 		sk->sk_data_ready(sk);
30 	}
31 }
32 
atm_pop_raw(struct atm_vcc * vcc,struct sk_buff * skb)33 static void atm_pop_raw(struct atm_vcc *vcc, struct sk_buff *skb)
34 {
35 	struct sock *sk = sk_atm(vcc);
36 
37 	pr_debug("(%d) %d -= %d\n",
38 		 vcc->vci, sk_wmem_alloc_get(sk), ATM_SKB(skb)->acct_truesize);
39 	WARN_ON(refcount_sub_and_test(ATM_SKB(skb)->acct_truesize, &sk->sk_wmem_alloc));
40 	dev_kfree_skb_any(skb);
41 	sk->sk_write_space(sk);
42 }
43 
atm_send_aal0(struct atm_vcc * vcc,struct sk_buff * skb)44 static int atm_send_aal0(struct atm_vcc *vcc, struct sk_buff *skb)
45 {
46 	/*
47 	 * Note that if vpi/vci are _ANY or _UNSPEC the below will
48 	 * still work
49 	 */
50 	if (!capable(CAP_NET_ADMIN) &&
51 	    (((u32 *)skb->data)[0] & (ATM_HDR_VPI_MASK | ATM_HDR_VCI_MASK)) !=
52 	    ((vcc->vpi << ATM_HDR_VPI_SHIFT) |
53 	     (vcc->vci << ATM_HDR_VCI_SHIFT))) {
54 		kfree_skb(skb);
55 		return -EADDRNOTAVAIL;
56 	}
57 	if (vcc->dev->ops->send_bh)
58 		return vcc->dev->ops->send_bh(vcc, skb);
59 	return vcc->dev->ops->send(vcc, skb);
60 }
61 
atm_init_aal0(struct atm_vcc * vcc)62 int atm_init_aal0(struct atm_vcc *vcc)
63 {
64 	vcc->push = atm_push_raw;
65 	vcc->pop = atm_pop_raw;
66 	vcc->push_oam = NULL;
67 	vcc->send = atm_send_aal0;
68 	return 0;
69 }
70 
atm_init_aal34(struct atm_vcc * vcc)71 int atm_init_aal34(struct atm_vcc *vcc)
72 {
73 	vcc->push = atm_push_raw;
74 	vcc->pop = atm_pop_raw;
75 	vcc->push_oam = NULL;
76 	if (vcc->dev->ops->send_bh)
77 		vcc->send = vcc->dev->ops->send_bh;
78 	else
79 		vcc->send = vcc->dev->ops->send;
80 	return 0;
81 }
82 
atm_init_aal5(struct atm_vcc * vcc)83 int atm_init_aal5(struct atm_vcc *vcc)
84 {
85 	vcc->push = atm_push_raw;
86 	vcc->pop = atm_pop_raw;
87 	vcc->push_oam = NULL;
88 	if (vcc->dev->ops->send_bh)
89 		vcc->send = vcc->dev->ops->send_bh;
90 	else
91 		vcc->send = vcc->dev->ops->send;
92 	return 0;
93 }
94 EXPORT_SYMBOL(atm_init_aal5);
95