[net-next-2.6.git] / drivers / staging / otus / wrap_pkt.c

/*
 * Copyright (c) 2007-2008 Atheros Communications Inc.
 *
 * Permission to use, copy, modify, and/or distribute this software for any
 * purpose with or without fee is hereby granted, provided that the above
 * copyright notice and this permission notice appear in all copies.
 *
 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
 */
/*                                                                      */
/*  Module Name : wrap_pkt.c                                            */
/*                                                                      */
/*  Abstract                                                            */
/*     This module contains wrapper functions for packet handling       */
/*                                                                      */
/*  NOTES                                                               */
/*     Platform dependent.                                              */
/*                                                                      */
/************************************************************************/

#include "oal_dt.h"
#include "usbdrv.h"

#include <linux/netlink.h>
#include <linux/gfp.h>
#include <net/iw_handler.h>


/* extern struct zsWdsStruct wds[ZM_WDS_PORT_NUMBER]; 	*/
extern struct zsVapStruct vap[ZM_VAP_PORT_NUMBER];


/***** Rx *****/
void zfLnxRecv80211(zdev_t *dev, zbuf_t *buf, struct zsAdditionInfo *addInfo)
{
	u16_t frameType;
	u16_t frameCtrl;
	u16_t frameSubtype;
	zbuf_t *skb1;
	struct usbdrv_private *macp = dev->ml_priv;

	/* frameCtrl = zmw_buf_readb(dev, buf, 0);	*/
	frameCtrl = *(u8_t *)((u8_t *)buf->data);
	frameType = frameCtrl & 0xf;
	frameSubtype = frameCtrl & 0xf0;

	if ((frameType == 0x0) && (macp->forwardMgmt)) {
		switch (frameSubtype) {
			/* Beacon */
		case 0x80:
			/* Probe response */
		case 0x50:
			skb1 = skb_copy(buf, GFP_ATOMIC);
			if (skb1 != NULL) {
				skb1->dev = dev;
				skb_reset_mac_header(skb1);
				skb1->ip_summed = CHECKSUM_NONE;
				skb1->pkt_type = PACKET_OTHERHOST;
				/* ETH_P_80211_RAW */
				skb1->protocol = __constant_htons(0x0019);
				netif_rx(skb1);
			}
			break;
		default:
			break;
		}
	}

	zfiRecv80211(dev, buf, addInfo);
	return;
}

#define ZM_AVOID_UDP_LARGE_PACKET_FAIL
void zfLnxRecvEth(zdev_t *dev, zbuf_t *buf, u16_t port)
{
	struct usbdrv_private *macp = dev->ml_priv;
#ifdef ZM_AVOID_UDP_LARGE_PACKET_FAIL
	zbuf_t *new_buf;

	/* new_buf = dev_alloc_skb(2048);	*/
	new_buf = dev_alloc_skb(buf->len);

	skb_reset_tail_pointer(new_buf);

	skb_put(new_buf, buf->len);
	memcpy(new_buf->data, buf->data, buf->len);

	/* Free buffer */
	dev_kfree_skb_any(buf);

	if (port == 0) {
		new_buf->dev = dev;
		new_buf->protocol = eth_type_trans(new_buf, dev);
	} else {
		/* VAP */
		if (vap[0].dev != NULL) {
			new_buf->dev = vap[0].dev;
			new_buf->protocol = eth_type_trans(new_buf, vap[0].dev);
		} else {
			new_buf->dev = dev;
			new_buf->protocol = eth_type_trans(new_buf, dev);
		}
	}

	new_buf->ip_summed = CHECKSUM_NONE;
	dev->last_rx = jiffies;

	switch (netif_rx(new_buf))
#else
	if (port == 0) {
		buf->dev = dev;
		buf->protocol = eth_type_trans(buf, dev);
	} else {
		/* VAP */
		if (vap[0].dev != NULL) {
			buf->dev = vap[0].dev;
			buf->protocol = eth_type_trans(buf, vap[0].dev);
		} else {
			buf->dev = dev;
			buf->protocol = eth_type_trans(buf, dev);
		}
	}

	buf->ip_summed = CHECKSUM_NONE;
	dev->last_rx = jiffies;

	switch (netif_rx(buf))
#endif
	{
	case NET_RX_DROP:
		break;
	default:
			macp->drv_stats.net_stats.rx_packets++;
			macp->drv_stats.net_stats.rx_bytes += buf->len;
		break;
	}

	return;
}

/* Leave an empty line below to remove warning message on some compiler */
Commit	Line	Data
4bd43f50 LR	1	/*
	2	* Copyright (c) 2007-2008 Atheros Communications Inc.
	3	*
	4	* Permission to use, copy, modify, and/or distribute this software for any
	5	* purpose with or without fee is hereby granted, provided that the above
	6	* copyright notice and this permission notice appear in all copies.
	7	*
	8	* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
	9	* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
	10	* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
	11	* ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
	12	* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
	13	* ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
	14	* OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
	15	*/
	16	/* */
	17	/* Module Name : wrap_pkt.c */
	18	/* */
	19	/* Abstract */
	20	/* This module contains wrapper functions for packet handling */
	21	/* */
	22	/* NOTES */
	23	/* Platform dependent. */
	24	/* */
	25	/************************************************************************/
	26
	27	#include "oal_dt.h"
	28	#include "usbdrv.h"
	29
	30	#include <linux/netlink.h>
5a0e3ad6	31	#include <linux/gfp.h>
4bd43f50	32	#include <net/iw_handler.h>
4bd43f50 LR	33
4bd43f50 LR	34
2bef7a0f	35	/* extern struct zsWdsStruct wds[ZM_WDS_PORT_NUMBER]; */
4bd43f50 LR	36	extern struct zsVapStruct vap[ZM_VAP_PORT_NUMBER];
	37
	38
	39	/*** Rx ***/
2bef7a0f	40	void zfLnxRecv80211(zdev_t dev, zbuf_t buf, struct zsAdditionInfo *addInfo)
4bd43f50	41	{
2bef7a0f MT	42	u16_t frameType;
	43	u16_t frameCtrl;
	44	u16_t frameSubtype;
	45	zbuf_t *skb1;
	46	struct usbdrv_private *macp = dev->ml_priv;
	47
	48	/* frameCtrl = zmw_buf_readb(dev, buf, 0); */
	49	frameCtrl = (u8_t )((u8_t *)buf->data);
	50	frameType = frameCtrl & 0xf;
	51	frameSubtype = frameCtrl & 0xf0;
	52
	53	if ((frameType == 0x0) && (macp->forwardMgmt)) {
	54	switch (frameSubtype) {
	55	/* Beacon */
	56	case 0x80:
	57	/* Probe response */
	58	case 0x50:
	59	skb1 = skb_copy(buf, GFP_ATOMIC);
	60	if (skb1 != NULL) {
	61	skb1->dev = dev;
23639126	62	skb_reset_mac_header(skb1);
2bef7a0f MT	63	skb1->ip_summed = CHECKSUM_NONE;
	64	skb1->pkt_type = PACKET_OTHERHOST;
	65	/* ETH_P_80211_RAW */
	66	skb1->protocol = __constant_htons(0x0019);
	67	netif_rx(skb1);
	68	}
	69	break;
	70	default:
	71	break;
	72	}
	73	}
	74
	75	zfiRecv80211(dev, buf, addInfo);
	76	return;
4bd43f50 LR	77	}
	78
	79	#define ZM_AVOID_UDP_LARGE_PACKET_FAIL
2bef7a0f	80	void zfLnxRecvEth(zdev_t dev, zbuf_t buf, u16_t port)
4bd43f50	81	{
2bef7a0f	82	struct usbdrv_private *macp = dev->ml_priv;
4bd43f50	83	#ifdef ZM_AVOID_UDP_LARGE_PACKET_FAIL
2bef7a0f	84	zbuf_t *new_buf;
4bd43f50	85
2bef7a0f MT	86	/* new_buf = dev_alloc_skb(2048); */
2bef7a0f MT	87	new_buf = dev_alloc_skb(buf->len);
4bd43f50	88
23639126	89	skb_reset_tail_pointer(new_buf);
4bd43f50	90
2bef7a0f MT	91	skb_put(new_buf, buf->len);
	92	memcpy(new_buf->data, buf->data, buf->len);
	93
	94	/* Free buffer */
	95	dev_kfree_skb_any(buf);
	96
	97	if (port == 0) {
	98	new_buf->dev = dev;
	99	new_buf->protocol = eth_type_trans(new_buf, dev);
	100	} else {
	101	/* VAP */
	102	if (vap[0].dev != NULL) {
	103	new_buf->dev = vap[0].dev;
	104	new_buf->protocol = eth_type_trans(new_buf, vap[0].dev);
	105	} else {
	106	new_buf->dev = dev;
	107	new_buf->protocol = eth_type_trans(new_buf, dev);
	108	}
	109	}
	110
	111	new_buf->ip_summed = CHECKSUM_NONE;
	112	dev->last_rx = jiffies;
	113
	114	switch (netif_rx(new_buf))
4bd43f50	115	#else
2bef7a0f MT	116	if (port == 0) {
	117	buf->dev = dev;
	118	buf->protocol = eth_type_trans(buf, dev);
	119	} else {
	120	/* VAP */
	121	if (vap[0].dev != NULL) {
	122	buf->dev = vap[0].dev;
	123	buf->protocol = eth_type_trans(buf, vap[0].dev);
	124	} else {
	125	buf->dev = dev;
	126	buf->protocol = eth_type_trans(buf, dev);
	127	}
	128	}
	129
	130	buf->ip_summed = CHECKSUM_NONE;
	131	dev->last_rx = jiffies;
	132
	133	switch (netif_rx(buf))
4bd43f50	134	#endif
2bef7a0f MT	135	{
	136	case NET_RX_DROP:
	137	break;
	138	default:
	139	macp->drv_stats.net_stats.rx_packets++;
	140	macp->drv_stats.net_stats.rx_bytes += buf->len;
	141	break;
	142	}
	143
	144	return;
4bd43f50 LR	145	}
	146
	147	/* Leave an empty line below to remove warning message on some compiler */