[mirror_ubuntu-jammy-kernel.git] / net / atm / raw.c

// SPDX-License-Identifier: GPL-2.0
/* net/atm/raw.c - Raw AAL0 and AAL5 transports */

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

#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__

#include <linux/module.h>
#include <linux/atmdev.h>
#include <linux/capability.h>
#include <linux/kernel.h>
#include <linux/skbuff.h>
#include <linux/mm.h>
#include <linux/slab.h>

#include "common.h"
#include "protocols.h"

/*
 * SKB == NULL indicates that the link is being closed
 */

static void atm_push_raw(struct atm_vcc *vcc, struct sk_buff *skb)
{
	if (skb) {
		struct sock *sk = sk_atm(vcc);

		skb_queue_tail(&sk->sk_receive_queue, skb);
		sk->sk_data_ready(sk);
	}
}

static void atm_pop_raw(struct atm_vcc *vcc, struct sk_buff *skb)
{
	struct sock *sk = sk_atm(vcc);

	pr_debug("(%d) %d -= %d\n",
		 vcc->vci, sk_wmem_alloc_get(sk), ATM_SKB(skb)->acct_truesize);
	WARN_ON(refcount_sub_and_test(ATM_SKB(skb)->acct_truesize, &sk->sk_wmem_alloc));
	dev_kfree_skb_any(skb);
	sk->sk_write_space(sk);
}

static int atm_send_aal0(struct atm_vcc *vcc, struct sk_buff *skb)
{
	/*
	 * Note that if vpi/vci are _ANY or _UNSPEC the below will
	 * still work
	 */
	if (!capable(CAP_NET_ADMIN) &&
	    (((u32 *)skb->data)[0] & (ATM_HDR_VPI_MASK | ATM_HDR_VCI_MASK)) !=
	    ((vcc->vpi << ATM_HDR_VPI_SHIFT) |
	     (vcc->vci << ATM_HDR_VCI_SHIFT))) {
		kfree_skb(skb);
		return -EADDRNOTAVAIL;
	}
	if (vcc->dev->ops->send_bh)
		return vcc->dev->ops->send_bh(vcc, skb);
	return vcc->dev->ops->send(vcc, skb);
}

int atm_init_aal0(struct atm_vcc *vcc)
{
	vcc->push = atm_push_raw;
	vcc->pop = atm_pop_raw;
	vcc->push_oam = NULL;
	vcc->send = atm_send_aal0;
	return 0;
}

int atm_init_aal34(struct atm_vcc *vcc)
{
	vcc->push = atm_push_raw;
	vcc->pop = atm_pop_raw;
	vcc->push_oam = NULL;
	if (vcc->dev->ops->send_bh)
		vcc->send = vcc->dev->ops->send_bh;
	else
		vcc->send = vcc->dev->ops->send;
	return 0;
}

int atm_init_aal5(struct atm_vcc *vcc)
{
	vcc->push = atm_push_raw;
	vcc->pop = atm_pop_raw;
	vcc->push_oam = NULL;
	if (vcc->dev->ops->send_bh)
		vcc->send = vcc->dev->ops->send_bh;
	else
		vcc->send = vcc->dev->ops->send;
	return 0;
}
EXPORT_SYMBOL(atm_init_aal5);
Commit	Line	Data
b2441318	1	// SPDX-License-Identifier: GPL-2.0
1da177e4 LT	2	/* net/atm/raw.c - Raw AAL0 and AAL5 transports */
	3
	4	/* Written 1995-2000 by Werner Almesberger, EPFL LRC/ICA */
	5
99824461	6	#define pr_fmt(fmt) KBUILD_MODNAME ":%s: " fmt, __func__
1da177e4 LT	7
1da177e4 LT	8	#include <linux/module.h>
1da177e4	9	#include <linux/atmdev.h>
4fc268d2	10	#include <linux/capability.h>
1da177e4 LT	11	#include <linux/kernel.h>
	12	#include <linux/skbuff.h>
	13	#include <linux/mm.h>
5a0e3ad6	14	#include <linux/slab.h>
1da177e4 LT	15
	16	#include "common.h"
	17	#include "protocols.h"
	18
1da177e4 LT	19	/*
	20	* SKB == NULL indicates that the link is being closed
	21	*/
	22
fa61f0ca	23	static void atm_push_raw(struct atm_vcc vcc, struct sk_buff skb)
1da177e4 LT	24	{
	25	if (skb) {
	26	struct sock *sk = sk_atm(vcc);
	27
	28	skb_queue_tail(&sk->sk_receive_queue, skb);
676d2369	29	sk->sk_data_ready(sk);
1da177e4 LT	30	}
	31	}
	32
fa61f0ca	33	static void atm_pop_raw(struct atm_vcc vcc, struct sk_buff skb)
1da177e4 LT	34	{
	35	struct sock *sk = sk_atm(vcc);
	36
99824461	37	pr_debug("(%d) %d -= %d\n",
9bbe60a6 DW	38	vcc->vci, sk_wmem_alloc_get(sk), ATM_SKB(skb)->acct_truesize);
9bbe60a6 DW	39	WARN_ON(refcount_sub_and_test(ATM_SKB(skb)->acct_truesize, &sk->sk_wmem_alloc));
1da177e4 LT	40	dev_kfree_skb_any(skb);
	41	sk->sk_write_space(sk);
	42	}
	43
fa61f0ca	44	static int atm_send_aal0(struct atm_vcc vcc, struct sk_buff skb)
1da177e4 LT	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) &&
fa61f0ca JP	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))) {
1da177e4 LT	54	kfree_skb(skb);
1da177e4 LT	55	return -EADDRNOTAVAIL;
f7d57453	56	}
f2bcc2fa SAS	57	if (vcc->dev->ops->send_bh)
f2bcc2fa SAS	58	return vcc->dev->ops->send_bh(vcc, skb);
fa61f0ca	59	return vcc->dev->ops->send(vcc, skb);
1da177e4 LT	60	}
1da177e4 LT	61
1da177e4 LT	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
1da177e4 LT	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;
f2bcc2fa SAS	76	if (vcc->dev->ops->send_bh)
	77	vcc->send = vcc->dev->ops->send_bh;
	78	else
	79	vcc->send = vcc->dev->ops->send;
1da177e4 LT	80	return 0;
	81	}
	82
1da177e4 LT	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;
f2bcc2fa SAS	88	if (vcc->dev->ops->send_bh)
	89	vcc->send = vcc->dev->ops->send_bh;
	90	else
	91	vcc->send = vcc->dev->ops->send;
1da177e4 LT	92	return 0;
1da177e4 LT	93	}
1da177e4	94	EXPORT_SYMBOL(atm_init_aal5);