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> | |
4bd43f50 | 31 | #include <net/iw_handler.h> |
4bd43f50 LR |
32 | |
33 | ||
2bef7a0f | 34 | /* extern struct zsWdsStruct wds[ZM_WDS_PORT_NUMBER]; */ |
4bd43f50 LR |
35 | extern struct zsVapStruct vap[ZM_VAP_PORT_NUMBER]; |
36 | ||
37 | ||
38 | /***** Rx *****/ | |
2bef7a0f | 39 | void zfLnxRecv80211(zdev_t *dev, zbuf_t *buf, struct zsAdditionInfo *addInfo) |
4bd43f50 | 40 | { |
2bef7a0f MT |
41 | u16_t frameType; |
42 | u16_t frameCtrl; | |
43 | u16_t frameSubtype; | |
44 | zbuf_t *skb1; | |
45 | struct usbdrv_private *macp = dev->ml_priv; | |
46 | ||
47 | /* frameCtrl = zmw_buf_readb(dev, buf, 0); */ | |
48 | frameCtrl = *(u8_t *)((u8_t *)buf->data); | |
49 | frameType = frameCtrl & 0xf; | |
50 | frameSubtype = frameCtrl & 0xf0; | |
51 | ||
52 | if ((frameType == 0x0) && (macp->forwardMgmt)) { | |
53 | switch (frameSubtype) { | |
54 | /* Beacon */ | |
55 | case 0x80: | |
56 | /* Probe response */ | |
57 | case 0x50: | |
58 | skb1 = skb_copy(buf, GFP_ATOMIC); | |
59 | if (skb1 != NULL) { | |
60 | skb1->dev = dev; | |
23639126 | 61 | skb_reset_mac_header(skb1); |
2bef7a0f MT |
62 | skb1->ip_summed = CHECKSUM_NONE; |
63 | skb1->pkt_type = PACKET_OTHERHOST; | |
64 | /* ETH_P_80211_RAW */ | |
65 | skb1->protocol = __constant_htons(0x0019); | |
66 | netif_rx(skb1); | |
67 | } | |
68 | break; | |
69 | default: | |
70 | break; | |
71 | } | |
72 | } | |
73 | ||
74 | zfiRecv80211(dev, buf, addInfo); | |
75 | return; | |
4bd43f50 LR |
76 | } |
77 | ||
78 | #define ZM_AVOID_UDP_LARGE_PACKET_FAIL | |
2bef7a0f | 79 | void zfLnxRecvEth(zdev_t *dev, zbuf_t *buf, u16_t port) |
4bd43f50 | 80 | { |
2bef7a0f | 81 | struct usbdrv_private *macp = dev->ml_priv; |
4bd43f50 | 82 | #ifdef ZM_AVOID_UDP_LARGE_PACKET_FAIL |
2bef7a0f | 83 | zbuf_t *new_buf; |
4bd43f50 | 84 | |
2bef7a0f MT |
85 | /* new_buf = dev_alloc_skb(2048); */ |
86 | new_buf = dev_alloc_skb(buf->len); | |
4bd43f50 | 87 | |
23639126 | 88 | skb_reset_tail_pointer(new_buf); |
4bd43f50 | 89 | |
2bef7a0f MT |
90 | skb_put(new_buf, buf->len); |
91 | memcpy(new_buf->data, buf->data, buf->len); | |
92 | ||
93 | /* Free buffer */ | |
94 | dev_kfree_skb_any(buf); | |
95 | ||
96 | if (port == 0) { | |
97 | new_buf->dev = dev; | |
98 | new_buf->protocol = eth_type_trans(new_buf, dev); | |
99 | } else { | |
100 | /* VAP */ | |
101 | if (vap[0].dev != NULL) { | |
102 | new_buf->dev = vap[0].dev; | |
103 | new_buf->protocol = eth_type_trans(new_buf, vap[0].dev); | |
104 | } else { | |
105 | new_buf->dev = dev; | |
106 | new_buf->protocol = eth_type_trans(new_buf, dev); | |
107 | } | |
108 | } | |
109 | ||
110 | new_buf->ip_summed = CHECKSUM_NONE; | |
111 | dev->last_rx = jiffies; | |
112 | ||
113 | switch (netif_rx(new_buf)) | |
4bd43f50 | 114 | #else |
2bef7a0f MT |
115 | if (port == 0) { |
116 | buf->dev = dev; | |
117 | buf->protocol = eth_type_trans(buf, dev); | |
118 | } else { | |
119 | /* VAP */ | |
120 | if (vap[0].dev != NULL) { | |
121 | buf->dev = vap[0].dev; | |
122 | buf->protocol = eth_type_trans(buf, vap[0].dev); | |
123 | } else { | |
124 | buf->dev = dev; | |
125 | buf->protocol = eth_type_trans(buf, dev); | |
126 | } | |
127 | } | |
128 | ||
129 | buf->ip_summed = CHECKSUM_NONE; | |
130 | dev->last_rx = jiffies; | |
131 | ||
132 | switch (netif_rx(buf)) | |
4bd43f50 | 133 | #endif |
2bef7a0f MT |
134 | { |
135 | case NET_RX_DROP: | |
136 | break; | |
137 | default: | |
138 | macp->drv_stats.net_stats.rx_packets++; | |
139 | macp->drv_stats.net_stats.rx_bytes += buf->len; | |
140 | break; | |
141 | } | |
142 | ||
143 | return; | |
4bd43f50 LR |
144 | } |
145 | ||
146 | /* Leave an empty line below to remove warning message on some compiler */ |