[GitHub/mt8127/android_kernel_alcatel_ttab.git] / net / atm / raw.c

/* 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 "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, skb->len);
	}
}

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