libertas: Use netdev_<level> or dev_<level> where possible
[deliverable/linux.git] / drivers / net / wireless / libertas / rx.c
CommitLineData
8973a6e7
RD
1/*
2 * This file contains the handling of RX in wlan driver.
3 */
0e4e06ae
JP
4
5#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
6
876c9d3a 7#include <linux/etherdevice.h>
5a0e3ad6 8#include <linux/slab.h>
876c9d3a 9#include <linux/types.h>
e86dc1ca 10#include <net/cfg80211.h>
876c9d3a 11
e86dc1ca 12#include "defs.h"
9e66e701 13#include "host.h"
876c9d3a
MT
14#include "radiotap.h"
15#include "decl.h"
16#include "dev.h"
876c9d3a
MT
17
18struct eth803hdr {
19 u8 dest_addr[6];
20 u8 src_addr[6];
21 u16 h803_len;
ba2d3587 22} __packed;
876c9d3a
MT
23
24struct rfc1042hdr {
25 u8 llc_dsap;
26 u8 llc_ssap;
27 u8 llc_ctrl;
28 u8 snap_oui[3];
29 u16 snap_type;
ba2d3587 30} __packed;
876c9d3a
MT
31
32struct rxpackethdr {
876c9d3a
MT
33 struct eth803hdr eth803_hdr;
34 struct rfc1042hdr rfc1042_hdr;
ba2d3587 35} __packed;
876c9d3a
MT
36
37struct rx80211packethdr {
38 struct rxpd rx_pd;
39 void *eth80211_hdr;
ba2d3587 40} __packed;
876c9d3a 41
69f9032d
HS
42static int process_rxed_802_11_packet(struct lbs_private *priv,
43 struct sk_buff *skb);
876c9d3a 44
876c9d3a 45/**
8973a6e7
RD
46 * lbs_process_rxed_packet - processes received packet and forwards it
47 * to kernel/upper layer
876c9d3a 48 *
8973a6e7
RD
49 * @priv: A pointer to &struct lbs_private
50 * @skb: A pointer to skb which includes the received packet
51 * returns: 0 or -1
876c9d3a 52 */
69f9032d 53int lbs_process_rxed_packet(struct lbs_private *priv, struct sk_buff *skb)
876c9d3a 54{
876c9d3a 55 int ret = 0;
6f93a8e7 56 struct net_device *dev = priv->dev;
876c9d3a
MT
57 struct rxpackethdr *p_rx_pkt;
58 struct rxpd *p_rx_pd;
876c9d3a
MT
59 int hdrchop;
60 struct ethhdr *p_ethhdr;
482e039f
JP
61 static const u8 rfc1042_eth_hdr[] = {
62 0xaa, 0xaa, 0x03, 0x00, 0x00, 0x00
63 };
876c9d3a 64
9012b28a 65 lbs_deb_enter(LBS_DEB_RX);
876c9d3a 66
7919b89c
HS
67 BUG_ON(!skb);
68
6f93a8e7
DW
69 skb->ip_summed = CHECKSUM_NONE;
70
e86dc1ca 71 if (priv->wdev->iftype == NL80211_IFTYPE_MONITOR)
876c9d3a
MT
72 return process_rxed_802_11_packet(priv, skb);
73
e45d8e53
BZ
74 p_rx_pd = (struct rxpd *) skb->data;
75 p_rx_pkt = (struct rxpackethdr *) ((u8 *)p_rx_pd +
76 le32_to_cpu(p_rx_pd->pkt_ptr));
e0e42da3
HS
77
78 dev = lbs_mesh_set_dev(priv, dev, p_rx_pd);
876c9d3a 79
ece56191 80 lbs_deb_hex(LBS_DEB_RX, "RX Data: Before chop rxpd", skb->data,
876c9d3a
MT
81 min_t(unsigned int, skb->len, 100));
82
83 if (skb->len < (ETH_HLEN + 8 + sizeof(struct rxpd))) {
9012b28a 84 lbs_deb_rx("rx err: frame received with bad length\n");
bbfc6b78 85 dev->stats.rx_length_errors++;
876c9d3a 86 ret = 0;
f54930f3 87 dev_kfree_skb(skb);
876c9d3a
MT
88 goto done;
89 }
90
e45d8e53 91 lbs_deb_rx("rx data: skb->len - pkt_ptr = %d-%zd = %zd\n",
a2caba6b
JL
92 skb->len, (size_t)le32_to_cpu(p_rx_pd->pkt_ptr),
93 skb->len - (size_t)le32_to_cpu(p_rx_pd->pkt_ptr));
876c9d3a 94
ece56191 95 lbs_deb_hex(LBS_DEB_RX, "RX Data: Dest", p_rx_pkt->eth803_hdr.dest_addr,
876c9d3a 96 sizeof(p_rx_pkt->eth803_hdr.dest_addr));
ece56191 97 lbs_deb_hex(LBS_DEB_RX, "RX Data: Src", p_rx_pkt->eth803_hdr.src_addr,
876c9d3a
MT
98 sizeof(p_rx_pkt->eth803_hdr.src_addr));
99
100 if (memcmp(&p_rx_pkt->rfc1042_hdr,
101 rfc1042_eth_hdr, sizeof(rfc1042_eth_hdr)) == 0) {
102 /*
103 * Replace the 803 header and rfc1042 header (llc/snap) with an
104 * EthernetII header, keep the src/dst and snap_type (ethertype)
105 *
106 * The firmware only passes up SNAP frames converting
107 * all RX Data from 802.11 to 802.2/LLC/SNAP frames.
108 *
109 * To create the Ethernet II, just move the src, dst address right
110 * before the snap_type.
111 */
112 p_ethhdr = (struct ethhdr *)
819cf15e 113 ((u8 *) &p_rx_pkt->eth803_hdr
876c9d3a
MT
114 + sizeof(p_rx_pkt->eth803_hdr) + sizeof(p_rx_pkt->rfc1042_hdr)
115 - sizeof(p_rx_pkt->eth803_hdr.dest_addr)
116 - sizeof(p_rx_pkt->eth803_hdr.src_addr)
117 - sizeof(p_rx_pkt->rfc1042_hdr.snap_type));
118
119 memcpy(p_ethhdr->h_source, p_rx_pkt->eth803_hdr.src_addr,
120 sizeof(p_ethhdr->h_source));
121 memcpy(p_ethhdr->h_dest, p_rx_pkt->eth803_hdr.dest_addr,
122 sizeof(p_ethhdr->h_dest));
123
124 /* Chop off the rxpd + the excess memory from the 802.2/llc/snap header
125 * that was removed
126 */
e45d8e53 127 hdrchop = (u8 *)p_ethhdr - (u8 *)p_rx_pd;
876c9d3a 128 } else {
ece56191 129 lbs_deb_hex(LBS_DEB_RX, "RX Data: LLC/SNAP",
819cf15e 130 (u8 *) &p_rx_pkt->rfc1042_hdr,
876c9d3a
MT
131 sizeof(p_rx_pkt->rfc1042_hdr));
132
133 /* Chop off the rxpd */
e45d8e53 134 hdrchop = (u8 *)&p_rx_pkt->eth803_hdr - (u8 *)p_rx_pd;
876c9d3a
MT
135 }
136
137 /* Chop off the leading header bytes so the skb points to the start of
138 * either the reconstructed EthII frame or the 802.2/llc/snap frame
139 */
140 skb_pull(skb, hdrchop);
141
e86dc1ca 142 priv->cur_rate = lbs_fw_index_to_data_rate(p_rx_pd->rx_rate);
876c9d3a 143
9012b28a 144 lbs_deb_rx("rx data: size of actual packet %d\n", skb->len);
bbfc6b78
SH
145 dev->stats.rx_bytes += skb->len;
146 dev->stats.rx_packets++;
876c9d3a 147
6f93a8e7 148 skb->protocol = eth_type_trans(skb, dev);
ae3e0fcf
HS
149 if (in_interrupt())
150 netif_rx(skb);
151 else
152 netif_rx_ni(skb);
3d4bd24b 153
876c9d3a
MT
154 ret = 0;
155done:
9012b28a 156 lbs_deb_leave_args(LBS_DEB_RX, "ret %d", ret);
876c9d3a
MT
157 return ret;
158}
10078321 159EXPORT_SYMBOL_GPL(lbs_process_rxed_packet);
876c9d3a
MT
160
161/**
8973a6e7
RD
162 * convert_mv_rate_to_radiotap - converts Tx/Rx rates from Marvell WLAN format
163 * (see Table 2 in Section 3.1) to IEEE80211_RADIOTAP_RATE units (500 Kb/s)
876c9d3a 164 *
8973a6e7
RD
165 * @rate: Input rate
166 * returns: Output Rate (0 if invalid)
876c9d3a
MT
167 */
168static u8 convert_mv_rate_to_radiotap(u8 rate)
169{
170 switch (rate) {
171 case 0: /* 1 Mbps */
172 return 2;
173 case 1: /* 2 Mbps */
174 return 4;
175 case 2: /* 5.5 Mbps */
176 return 11;
177 case 3: /* 11 Mbps */
178 return 22;
965f8bbc
LCC
179 /* case 4: reserved */
180 case 5: /* 6 Mbps */
876c9d3a 181 return 12;
965f8bbc 182 case 6: /* 9 Mbps */
876c9d3a 183 return 18;
965f8bbc 184 case 7: /* 12 Mbps */
876c9d3a 185 return 24;
965f8bbc 186 case 8: /* 18 Mbps */
876c9d3a 187 return 36;
965f8bbc 188 case 9: /* 24 Mbps */
876c9d3a 189 return 48;
965f8bbc 190 case 10: /* 36 Mbps */
876c9d3a 191 return 72;
965f8bbc 192 case 11: /* 48 Mbps */
876c9d3a 193 return 96;
965f8bbc 194 case 12: /* 54 Mbps */
876c9d3a
MT
195 return 108;
196 }
0e4e06ae 197 pr_alert("Invalid Marvell WLAN rate %i\n", rate);
876c9d3a
MT
198 return 0;
199}
200
201/**
8973a6e7
RD
202 * process_rxed_802_11_packet - processes a received 802.11 packet and forwards
203 * it to kernel/upper layer
876c9d3a 204 *
8973a6e7
RD
205 * @priv: A pointer to &struct lbs_private
206 * @skb: A pointer to skb which includes the received packet
207 * returns: 0 or -1
876c9d3a 208 */
69f9032d
HS
209static int process_rxed_802_11_packet(struct lbs_private *priv,
210 struct sk_buff *skb)
876c9d3a 211{
876c9d3a 212 int ret = 0;
bbfc6b78 213 struct net_device *dev = priv->dev;
876c9d3a
MT
214 struct rx80211packethdr *p_rx_pkt;
215 struct rxpd *prxpd;
216 struct rx_radiotap_hdr radiotap_hdr;
217 struct rx_radiotap_hdr *pradiotap_hdr;
218
9012b28a 219 lbs_deb_enter(LBS_DEB_RX);
876c9d3a
MT
220
221 p_rx_pkt = (struct rx80211packethdr *) skb->data;
222 prxpd = &p_rx_pkt->rx_pd;
223
819cf15e 224 /* lbs_deb_hex(LBS_DEB_RX, "RX Data: Before chop rxpd", skb->data, min(skb->len, 100)); */
876c9d3a
MT
225
226 if (skb->len < (ETH_HLEN + 8 + sizeof(struct rxpd))) {
7bf02c29 227 lbs_deb_rx("rx err: frame received with bad length\n");
bbfc6b78 228 dev->stats.rx_length_errors++;
7bf02c29 229 ret = -EINVAL;
b700a98c 230 kfree_skb(skb);
876c9d3a
MT
231 goto done;
232 }
233
9012b28a 234 lbs_deb_rx("rx data: skb->len-sizeof(RxPd) = %d-%zd = %zd\n",
876c9d3a
MT
235 skb->len, sizeof(struct rxpd), skb->len - sizeof(struct rxpd));
236
237 /* create the exported radio header */
876c9d3a 238
180be755 239 /* radiotap header */
c6a6368b
PB
240 memset(&radiotap_hdr, 0, sizeof(radiotap_hdr));
241 /* XXX must check radiotap_hdr.hdr.it_pad for pad */
180be755
DW
242 radiotap_hdr.hdr.it_len = cpu_to_le16 (sizeof(struct rx_radiotap_hdr));
243 radiotap_hdr.hdr.it_present = cpu_to_le32 (RX_RADIOTAP_PRESENT);
180be755
DW
244 radiotap_hdr.rate = convert_mv_rate_to_radiotap(prxpd->rx_rate);
245 /* XXX must check no carryout */
246 radiotap_hdr.antsignal = prxpd->snr + prxpd->nf;
180be755
DW
247
248 /* chop the rxpd */
249 skb_pull(skb, sizeof(struct rxpd));
250
251 /* add space for the new radio header */
252 if ((skb_headroom(skb) < sizeof(struct rx_radiotap_hdr)) &&
7bf02c29 253 pskb_expand_head(skb, sizeof(struct rx_radiotap_hdr), 0, GFP_ATOMIC)) {
f3a57fd1 254 netdev_alert(dev, "%s: couldn't pskb_expand_head\n", __func__);
7bf02c29
DW
255 ret = -ENOMEM;
256 kfree_skb(skb);
257 goto done;
876c9d3a
MT
258 }
259
180be755
DW
260 pradiotap_hdr = (void *)skb_push(skb, sizeof(struct rx_radiotap_hdr));
261 memcpy(pradiotap_hdr, &radiotap_hdr, sizeof(struct rx_radiotap_hdr));
262
e86dc1ca 263 priv->cur_rate = lbs_fw_index_to_data_rate(prxpd->rx_rate);
876c9d3a 264
9012b28a 265 lbs_deb_rx("rx data: size of actual packet %d\n", skb->len);
bbfc6b78
SH
266 dev->stats.rx_bytes += skb->len;
267 dev->stats.rx_packets++;
876c9d3a 268
e86dc1ca
KD
269 skb->protocol = eth_type_trans(skb, priv->dev);
270
271 if (in_interrupt())
272 netif_rx(skb);
273 else
274 netif_rx_ni(skb);
3d4bd24b 275
876c9d3a 276 ret = 0;
876c9d3a 277
9012b28a 278done:
9012b28a
HS
279 lbs_deb_leave_args(LBS_DEB_RX, "ret %d", ret);
280 return ret;
876c9d3a 281}
This page took 0.589478 seconds and 5 git commands to generate.