1 /*
2 * Marvell Wireless LAN device driver: generic TX/RX data handling
3 *
4 * Copyright (C) 2011-2014, Marvell International Ltd.
5 *
6 * This software file (the "File") is distributed by Marvell International
7 * Ltd. under the terms of the GNU General Public License Version 2, June 1991
8 * (the "License"). You may use, redistribute and/or modify this File in
9 * accordance with the terms and conditions of the License, a copy of which
10 * is available by writing to the Free Software Foundation, Inc.,
11 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
12 * worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
13 *
14 * THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
15 * IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
16 * ARE EXPRESSLY DISCLAIMED. The License provides additional details about
17 * this warranty disclaimer.
18 */
19
20 #include "decl.h"
21 #include "ioctl.h"
22 #include "util.h"
23 #include "fw.h"
24 #include "main.h"
25 #include "wmm.h"
26
27 /*
28 * This function processes the received buffer.
29 *
30 * Main responsibility of this function is to parse the RxPD to
31 * identify the correct interface this packet is headed for and
32 * forwarding it to the associated handling function, where the
33 * packet will be further processed and sent to kernel/upper layer
34 * if required.
35 */
mwifiex_handle_rx_packet(struct mwifiex_adapter * adapter,struct sk_buff * skb)36 int mwifiex_handle_rx_packet(struct mwifiex_adapter *adapter,
37 struct sk_buff *skb)
38 {
39 struct mwifiex_private *priv =
40 mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
41 struct rxpd *local_rx_pd;
42 struct mwifiex_rxinfo *rx_info = MWIFIEX_SKB_RXCB(skb);
43 int ret;
44
45 local_rx_pd = (struct rxpd *) (skb->data);
46 /* Get the BSS number from rxpd, get corresponding priv */
47 priv = mwifiex_get_priv_by_id(adapter, local_rx_pd->bss_num &
48 BSS_NUM_MASK, local_rx_pd->bss_type);
49 if (!priv)
50 priv = mwifiex_get_priv(adapter, MWIFIEX_BSS_ROLE_ANY);
51
52 if (!priv) {
53 dev_err(adapter->dev, "data: priv not found. Drop RX packet\n");
54 dev_kfree_skb_any(skb);
55 return -1;
56 }
57
58 memset(rx_info, 0, sizeof(*rx_info));
59 rx_info->bss_num = priv->bss_num;
60 rx_info->bss_type = priv->bss_type;
61
62 if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP)
63 ret = mwifiex_process_uap_rx_packet(priv, skb);
64 else
65 ret = mwifiex_process_sta_rx_packet(priv, skb);
66
67 return ret;
68 }
69 EXPORT_SYMBOL_GPL(mwifiex_handle_rx_packet);
70
71 /*
72 * This function sends a packet to device.
73 *
74 * It processes the packet to add the TxPD, checks condition and
75 * sends the processed packet to firmware for transmission.
76 *
77 * On successful completion, the function calls the completion callback
78 * and logs the time.
79 */
mwifiex_process_tx(struct mwifiex_private * priv,struct sk_buff * skb,struct mwifiex_tx_param * tx_param)80 int mwifiex_process_tx(struct mwifiex_private *priv, struct sk_buff *skb,
81 struct mwifiex_tx_param *tx_param)
82 {
83 int hroom, ret = -1;
84 struct mwifiex_adapter *adapter = priv->adapter;
85 u8 *head_ptr;
86 struct txpd *local_tx_pd = NULL;
87
88 hroom = (adapter->iface_type == MWIFIEX_USB) ? 0 : INTF_HEADER_LEN;
89
90 if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP)
91 head_ptr = mwifiex_process_uap_txpd(priv, skb);
92 else
93 head_ptr = mwifiex_process_sta_txpd(priv, skb);
94
95 if ((adapter->data_sent || adapter->tx_lock_flag) && head_ptr) {
96 skb_queue_tail(&adapter->tx_data_q, skb);
97 atomic_inc(&adapter->tx_queued);
98 return 0;
99 }
100
101 if (head_ptr) {
102 if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA)
103 local_tx_pd = (struct txpd *)(head_ptr + hroom);
104 if (adapter->iface_type == MWIFIEX_USB) {
105 adapter->data_sent = true;
106 ret = adapter->if_ops.host_to_card(adapter,
107 MWIFIEX_USB_EP_DATA,
108 skb, NULL);
109 } else {
110 ret = adapter->if_ops.host_to_card(adapter,
111 MWIFIEX_TYPE_DATA,
112 skb, tx_param);
113 }
114 }
115
116 switch (ret) {
117 case -ENOSR:
118 dev_dbg(adapter->dev, "data: -ENOSR is returned\n");
119 break;
120 case -EBUSY:
121 if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
122 (adapter->pps_uapsd_mode) && (adapter->tx_lock_flag)) {
123 priv->adapter->tx_lock_flag = false;
124 if (local_tx_pd)
125 local_tx_pd->flags = 0;
126 }
127 dev_dbg(adapter->dev, "data: -EBUSY is returned\n");
128 break;
129 case -1:
130 if (adapter->iface_type != MWIFIEX_PCIE)
131 adapter->data_sent = false;
132 dev_err(adapter->dev, "mwifiex_write_data_async failed: 0x%X\n",
133 ret);
134 adapter->dbg.num_tx_host_to_card_failure++;
135 mwifiex_write_data_complete(adapter, skb, 0, ret);
136 break;
137 case -EINPROGRESS:
138 if (adapter->iface_type != MWIFIEX_PCIE)
139 adapter->data_sent = false;
140 break;
141 case 0:
142 mwifiex_write_data_complete(adapter, skb, 0, ret);
143 break;
144 default:
145 break;
146 }
147
148 return ret;
149 }
150
mwifiex_host_to_card(struct mwifiex_adapter * adapter,struct sk_buff * skb,struct mwifiex_tx_param * tx_param)151 static int mwifiex_host_to_card(struct mwifiex_adapter *adapter,
152 struct sk_buff *skb,
153 struct mwifiex_tx_param *tx_param)
154 {
155 struct txpd *local_tx_pd = NULL;
156 u8 *head_ptr = skb->data;
157 int ret = 0;
158 struct mwifiex_private *priv;
159 struct mwifiex_txinfo *tx_info;
160
161 tx_info = MWIFIEX_SKB_TXCB(skb);
162 priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
163 tx_info->bss_type);
164 if (!priv) {
165 dev_err(adapter->dev, "data: priv not found. Drop TX packet\n");
166 adapter->dbg.num_tx_host_to_card_failure++;
167 mwifiex_write_data_complete(adapter, skb, 0, 0);
168 return ret;
169 }
170 if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) {
171 if (adapter->iface_type == MWIFIEX_USB)
172 local_tx_pd = (struct txpd *)head_ptr;
173 else
174 local_tx_pd = (struct txpd *) (head_ptr +
175 INTF_HEADER_LEN);
176 }
177
178 if (adapter->iface_type == MWIFIEX_USB) {
179 adapter->data_sent = true;
180 ret = adapter->if_ops.host_to_card(adapter,
181 MWIFIEX_USB_EP_DATA,
182 skb, NULL);
183 } else {
184 ret = adapter->if_ops.host_to_card(adapter,
185 MWIFIEX_TYPE_DATA,
186 skb, tx_param);
187 }
188 switch (ret) {
189 case -ENOSR:
190 dev_err(adapter->dev, "data: -ENOSR is returned\n");
191 break;
192 case -EBUSY:
193 if ((GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA) &&
194 (adapter->pps_uapsd_mode) &&
195 (adapter->tx_lock_flag)) {
196 priv->adapter->tx_lock_flag = false;
197 if (local_tx_pd)
198 local_tx_pd->flags = 0;
199 }
200 skb_queue_head(&adapter->tx_data_q, skb);
201 if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
202 atomic_add(tx_info->aggr_num, &adapter->tx_queued);
203 else
204 atomic_inc(&adapter->tx_queued);
205 dev_dbg(adapter->dev, "data: -EBUSY is returned\n");
206 break;
207 case -1:
208 if (adapter->iface_type != MWIFIEX_PCIE)
209 adapter->data_sent = false;
210 dev_err(adapter->dev, "mwifiex_write_data_async failed: 0x%X\n",
211 ret);
212 adapter->dbg.num_tx_host_to_card_failure++;
213 mwifiex_write_data_complete(adapter, skb, 0, ret);
214 break;
215 case -EINPROGRESS:
216 if (adapter->iface_type != MWIFIEX_PCIE)
217 adapter->data_sent = false;
218 break;
219 case 0:
220 mwifiex_write_data_complete(adapter, skb, 0, ret);
221 break;
222 default:
223 break;
224 }
225 return ret;
226 }
227
228 static int
mwifiex_dequeue_tx_queue(struct mwifiex_adapter * adapter)229 mwifiex_dequeue_tx_queue(struct mwifiex_adapter *adapter)
230 {
231 struct sk_buff *skb, *skb_next;
232 struct mwifiex_txinfo *tx_info;
233 struct mwifiex_tx_param tx_param;
234
235 skb = skb_dequeue(&adapter->tx_data_q);
236 if (!skb)
237 return -1;
238
239 tx_info = MWIFIEX_SKB_TXCB(skb);
240 if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
241 atomic_sub(tx_info->aggr_num, &adapter->tx_queued);
242 else
243 atomic_dec(&adapter->tx_queued);
244
245 if (!skb_queue_empty(&adapter->tx_data_q))
246 skb_next = skb_peek(&adapter->tx_data_q);
247 else
248 skb_next = NULL;
249 tx_param.next_pkt_len = ((skb_next) ? skb_next->len : 0);
250 if (!tx_param.next_pkt_len) {
251 if (!mwifiex_wmm_lists_empty(adapter))
252 tx_param.next_pkt_len = 1;
253 }
254 return mwifiex_host_to_card(adapter, skb, &tx_param);
255 }
256
257 void
mwifiex_process_tx_queue(struct mwifiex_adapter * adapter)258 mwifiex_process_tx_queue(struct mwifiex_adapter *adapter)
259 {
260 do {
261 if (adapter->data_sent || adapter->tx_lock_flag)
262 break;
263 if (mwifiex_dequeue_tx_queue(adapter))
264 break;
265 } while (!skb_queue_empty(&adapter->tx_data_q));
266 }
267
268 /*
269 * Packet send completion callback handler.
270 *
271 * It either frees the buffer directly or forwards it to another
272 * completion callback which checks conditions, updates statistics,
273 * wakes up stalled traffic queue if required, and then frees the buffer.
274 */
mwifiex_write_data_complete(struct mwifiex_adapter * adapter,struct sk_buff * skb,int aggr,int status)275 int mwifiex_write_data_complete(struct mwifiex_adapter *adapter,
276 struct sk_buff *skb, int aggr, int status)
277 {
278 struct mwifiex_private *priv;
279 struct mwifiex_txinfo *tx_info;
280 struct netdev_queue *txq;
281 int index;
282
283 if (!skb)
284 return 0;
285
286 tx_info = MWIFIEX_SKB_TXCB(skb);
287 priv = mwifiex_get_priv_by_id(adapter, tx_info->bss_num,
288 tx_info->bss_type);
289 if (!priv)
290 goto done;
291
292 if (adapter->iface_type == MWIFIEX_USB)
293 adapter->data_sent = false;
294
295 mwifiex_set_trans_start(priv->netdev);
296 if (!status) {
297 priv->stats.tx_packets++;
298 priv->stats.tx_bytes += tx_info->pkt_len;
299 if (priv->tx_timeout_cnt)
300 priv->tx_timeout_cnt = 0;
301 } else {
302 priv->stats.tx_errors++;
303 }
304
305 if (tx_info->flags & MWIFIEX_BUF_FLAG_BRIDGED_PKT) {
306 atomic_dec_return(&adapter->pending_bridged_pkts);
307 if (tx_info->flags & MWIFIEX_BUF_FLAG_AGGR_PKT)
308 goto done;
309 }
310
311 if (aggr)
312 /* For skb_aggr, do not wake up tx queue */
313 goto done;
314
315 atomic_dec(&adapter->tx_pending);
316
317 index = mwifiex_1d_to_wmm_queue[skb->priority];
318 if (atomic_dec_return(&priv->wmm_tx_pending[index]) < LOW_TX_PENDING) {
319 txq = netdev_get_tx_queue(priv->netdev, index);
320 if (netif_tx_queue_stopped(txq)) {
321 netif_tx_wake_queue(txq);
322 dev_dbg(adapter->dev, "wake queue: %d\n", index);
323 }
324 }
325 done:
326 dev_kfree_skb_any(skb);
327
328 return 0;
329 }
330 EXPORT_SYMBOL_GPL(mwifiex_write_data_complete);
331
mwifiex_parse_tx_status_event(struct mwifiex_private * priv,void * event_body)332 void mwifiex_parse_tx_status_event(struct mwifiex_private *priv,
333 void *event_body)
334 {
335 struct tx_status_event *tx_status = (void *)priv->adapter->event_body;
336 struct sk_buff *ack_skb;
337 unsigned long flags;
338 struct mwifiex_txinfo *tx_info;
339
340 if (!tx_status->tx_token_id)
341 return;
342
343 spin_lock_irqsave(&priv->ack_status_lock, flags);
344 ack_skb = idr_find(&priv->ack_status_frames, tx_status->tx_token_id);
345 if (ack_skb)
346 idr_remove(&priv->ack_status_frames, tx_status->tx_token_id);
347 spin_unlock_irqrestore(&priv->ack_status_lock, flags);
348
349 if (ack_skb) {
350 tx_info = MWIFIEX_SKB_TXCB(ack_skb);
351
352 if (tx_info->flags & MWIFIEX_BUF_FLAG_EAPOL_TX_STATUS) {
353 /* consumes ack_skb */
354 skb_complete_wifi_ack(ack_skb, !tx_status->status);
355 } else {
356 cfg80211_mgmt_tx_status(&priv->wdev, tx_info->cookie,
357 ack_skb->data, ack_skb->len,
358 !tx_status->status, GFP_ATOMIC);
359 dev_kfree_skb_any(ack_skb);
360 }
361 }
362 }
363