blob: 0dafcb0d7eb1397b7bef48cbc9545c6a34515e78 [file] [log] [blame]
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001/*
2 * Marvell Wireless LAN device driver: WMM
3 *
Xinming Hu65da33f2014-06-19 21:38:57 -07004 * Copyright (C) 2011-2014, Marvell International Ltd.
Bing Zhao5e6e3a92011-03-21 18:00:50 -07005 *
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#include "11n.h"
27
28
29/* Maximum value FW can accept for driver delay in packet transmission */
30#define DRV_PKT_DELAY_TO_FW_MAX 512
31
32
33#define WMM_QUEUED_PACKET_LOWER_LIMIT 180
34
35#define WMM_QUEUED_PACKET_UPPER_LIMIT 200
36
37/* Offset for TOS field in the IP header */
38#define IPTOS_OFFSET 5
39
Amitkumar Karwar4c9f9fb2014-03-07 19:41:31 -080040static bool disable_tx_amsdu;
41module_param(disable_tx_amsdu, bool, 0644);
Avinash Patilc9e24042013-06-04 16:20:38 -070042
Bing Zhao5e6e3a92011-03-21 18:00:50 -070043/* WMM information IE */
44static const u8 wmm_info_ie[] = { WLAN_EID_VENDOR_SPECIFIC, 0x07,
45 0x00, 0x50, 0xf2, 0x02,
46 0x00, 0x01, 0x00
47};
48
49static const u8 wmm_aci_to_qidx_map[] = { WMM_AC_BE,
50 WMM_AC_BK,
51 WMM_AC_VI,
52 WMM_AC_VO
53};
54
55static u8 tos_to_tid[] = {
56 /* TID DSCP_P2 DSCP_P1 DSCP_P0 WMM_AC */
57 0x01, /* 0 1 0 AC_BK */
58 0x02, /* 0 0 0 AC_BK */
59 0x00, /* 0 0 1 AC_BE */
60 0x03, /* 0 1 1 AC_BE */
61 0x04, /* 1 0 0 AC_VI */
62 0x05, /* 1 0 1 AC_VI */
63 0x06, /* 1 1 0 AC_VO */
64 0x07 /* 1 1 1 AC_VO */
65};
66
Bing Zhao5e6e3a92011-03-21 18:00:50 -070067static u8 ac_to_tid[4][2] = { {1, 2}, {0, 3}, {4, 5}, {6, 7} };
68
69/*
70 * This function debug prints the priority parameters for a WMM AC.
71 */
72static void
73mwifiex_wmm_ac_debug_print(const struct ieee_types_wmm_ac_parameters *ac_param)
74{
75 const char *ac_str[] = { "BK", "BE", "VI", "VO" };
76
77 pr_debug("info: WMM AC_%s: ACI=%d, ACM=%d, Aifsn=%d, "
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -070078 "EcwMin=%d, EcwMax=%d, TxopLimit=%d\n",
79 ac_str[wmm_aci_to_qidx_map[(ac_param->aci_aifsn_bitmap
80 & MWIFIEX_ACI) >> 5]],
81 (ac_param->aci_aifsn_bitmap & MWIFIEX_ACI) >> 5,
82 (ac_param->aci_aifsn_bitmap & MWIFIEX_ACM) >> 4,
83 ac_param->aci_aifsn_bitmap & MWIFIEX_AIFSN,
84 ac_param->ecw_bitmap & MWIFIEX_ECW_MIN,
85 (ac_param->ecw_bitmap & MWIFIEX_ECW_MAX) >> 4,
86 le16_to_cpu(ac_param->tx_op_limit));
Bing Zhao5e6e3a92011-03-21 18:00:50 -070087}
88
89/*
90 * This function allocates a route address list.
91 *
92 * The function also initializes the list with the provided RA.
93 */
94static struct mwifiex_ra_list_tbl *
Johannes Berg3b3a0162014-05-19 17:19:31 +020095mwifiex_wmm_allocate_ralist_node(struct mwifiex_adapter *adapter, const u8 *ra)
Bing Zhao5e6e3a92011-03-21 18:00:50 -070096{
97 struct mwifiex_ra_list_tbl *ra_list;
98
99 ra_list = kzalloc(sizeof(struct mwifiex_ra_list_tbl), GFP_ATOMIC);
Joe Perches0d2e7a52013-02-03 17:28:14 +0000100 if (!ra_list)
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700101 return NULL;
Joe Perches0d2e7a52013-02-03 17:28:14 +0000102
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700103 INIT_LIST_HEAD(&ra_list->list);
104 skb_queue_head_init(&ra_list->skb_head);
105
106 memcpy(ra_list->ra, ra, ETH_ALEN);
107
Avinash Patilc7d9ed92013-07-22 19:17:40 -0700108 ra_list->total_pkt_count = 0;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700109
110 dev_dbg(adapter->dev, "info: allocated ra_list %p\n", ra_list);
111
112 return ra_list;
113}
114
Avinash Patil5a009ad2012-08-03 18:06:10 -0700115/* This function returns random no between 16 and 32 to be used as threshold
116 * for no of packets after which BA setup is initiated.
117 */
118static u8 mwifiex_get_random_ba_threshold(void)
119{
120 u32 sec, usec;
121 struct timeval ba_tstamp;
122 u8 ba_threshold;
123
124 /* setup ba_packet_threshold here random number between
125 * [BA_SETUP_PACKET_OFFSET,
126 * BA_SETUP_PACKET_OFFSET+BA_SETUP_MAX_PACKET_THRESHOLD-1]
127 */
128
129 do_gettimeofday(&ba_tstamp);
130 sec = (ba_tstamp.tv_sec & 0xFFFF) + (ba_tstamp.tv_sec >> 16);
131 usec = (ba_tstamp.tv_usec & 0xFFFF) + (ba_tstamp.tv_usec >> 16);
132 ba_threshold = (((sec << 16) + usec) % BA_SETUP_MAX_PACKET_THRESHOLD)
133 + BA_SETUP_PACKET_OFFSET;
134
135 return ba_threshold;
136}
137
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700138/*
139 * This function allocates and adds a RA list for all TIDs
140 * with the given RA.
141 */
Johannes Berg3b3a0162014-05-19 17:19:31 +0200142void mwifiex_ralist_add(struct mwifiex_private *priv, const u8 *ra)
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700143{
144 int i;
145 struct mwifiex_ra_list_tbl *ra_list;
146 struct mwifiex_adapter *adapter = priv->adapter;
Avinash Patil5a009ad2012-08-03 18:06:10 -0700147 struct mwifiex_sta_node *node;
148 unsigned long flags;
149
150 spin_lock_irqsave(&priv->sta_list_spinlock, flags);
151 node = mwifiex_get_sta_entry(priv, ra);
152 spin_unlock_irqrestore(&priv->sta_list_spinlock, flags);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700153
154 for (i = 0; i < MAX_NUM_TID; ++i) {
155 ra_list = mwifiex_wmm_allocate_ralist_node(adapter, ra);
156 dev_dbg(adapter->dev, "info: created ra_list %p\n", ra_list);
157
158 if (!ra_list)
159 break;
160
Avinash Patil5a009ad2012-08-03 18:06:10 -0700161 ra_list->is_11n_enabled = 0;
Avinash Patildaeb5bb2014-02-07 16:30:37 -0800162 ra_list->tdls_link = false;
Avinash Patil5a009ad2012-08-03 18:06:10 -0700163 if (!mwifiex_queuing_ra_based(priv)) {
Avinash Patildaeb5bb2014-02-07 16:30:37 -0800164 if (mwifiex_get_tdls_link_status(priv, ra) ==
165 TDLS_SETUP_COMPLETE) {
Avinash Patila983e482014-05-27 21:39:33 -0700166 ra_list->tdls_link = true;
Avinash Patildaeb5bb2014-02-07 16:30:37 -0800167 ra_list->is_11n_enabled =
168 mwifiex_tdls_peer_11n_enabled(priv, ra);
169 } else {
170 ra_list->is_11n_enabled = IS_11N_ENABLED(priv);
171 }
Avinash Patil5a009ad2012-08-03 18:06:10 -0700172 } else {
173 ra_list->is_11n_enabled =
174 mwifiex_is_sta_11n_enabled(priv, node);
175 if (ra_list->is_11n_enabled)
176 ra_list->max_amsdu = node->max_amsdu;
177 }
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700178
179 dev_dbg(adapter->dev, "data: ralist %p: is_11n_enabled=%d\n",
180 ra_list, ra_list->is_11n_enabled);
181
Avinash Patil5a009ad2012-08-03 18:06:10 -0700182 if (ra_list->is_11n_enabled) {
Avinash Patilf0cb84f2013-07-22 19:17:39 -0700183 ra_list->ba_pkt_count = 0;
Avinash Patil5a009ad2012-08-03 18:06:10 -0700184 ra_list->ba_packet_thr =
185 mwifiex_get_random_ba_threshold();
186 }
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700187 list_add_tail(&ra_list->list,
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700188 &priv->wmm.tid_tbl_ptr[i].ra_list);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700189 }
190}
191
192/*
193 * This function sets the WMM queue priorities to their default values.
194 */
195static void mwifiex_wmm_default_queue_priorities(struct mwifiex_private *priv)
196{
197 /* Default queue priorities: VO->VI->BE->BK */
198 priv->wmm.queue_priority[0] = WMM_AC_VO;
199 priv->wmm.queue_priority[1] = WMM_AC_VI;
200 priv->wmm.queue_priority[2] = WMM_AC_BE;
201 priv->wmm.queue_priority[3] = WMM_AC_BK;
202}
203
204/*
205 * This function map ACs to TIDs.
206 */
207static void
Avinash Patil41a24a22014-02-07 16:27:29 -0800208mwifiex_wmm_queue_priorities_tid(struct mwifiex_private *priv)
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700209{
Avinash Patil41a24a22014-02-07 16:27:29 -0800210 struct mwifiex_wmm_desc *wmm = &priv->wmm;
Marc Yang49729ff2011-05-16 19:17:50 -0700211 u8 *queue_priority = wmm->queue_priority;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700212 int i;
213
214 for (i = 0; i < 4; ++i) {
215 tos_to_tid[7 - (i * 2)] = ac_to_tid[queue_priority[i]][1];
216 tos_to_tid[6 - (i * 2)] = ac_to_tid[queue_priority[i]][0];
217 }
Marc Yang49729ff2011-05-16 19:17:50 -0700218
219 for (i = 0; i < MAX_NUM_TID; ++i)
Avinash Patil41a24a22014-02-07 16:27:29 -0800220 priv->tos_to_tid_inv[tos_to_tid[i]] = (u8)i;
Marc Yang49729ff2011-05-16 19:17:50 -0700221
222 atomic_set(&wmm->highest_queued_prio, HIGH_PRIO_TID);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700223}
224
225/*
226 * This function initializes WMM priority queues.
227 */
228void
229mwifiex_wmm_setup_queue_priorities(struct mwifiex_private *priv,
230 struct ieee_types_wmm_parameter *wmm_ie)
231{
232 u16 cw_min, avg_back_off, tmp[4];
233 u32 i, j, num_ac;
234 u8 ac_idx;
235
236 if (!wmm_ie || !priv->wmm_enabled) {
237 /* WMM is not enabled, just set the defaults and return */
238 mwifiex_wmm_default_queue_priorities(priv);
239 return;
240 }
241
242 dev_dbg(priv->adapter->dev, "info: WMM Parameter IE: version=%d, "
243 "qos_info Parameter Set Count=%d, Reserved=%#x\n",
244 wmm_ie->vend_hdr.version, wmm_ie->qos_info_bitmap &
245 IEEE80211_WMM_IE_AP_QOSINFO_PARAM_SET_CNT_MASK,
246 wmm_ie->reserved);
247
248 for (num_ac = 0; num_ac < ARRAY_SIZE(wmm_ie->ac_params); num_ac++) {
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700249 u8 ecw = wmm_ie->ac_params[num_ac].ecw_bitmap;
250 u8 aci_aifsn = wmm_ie->ac_params[num_ac].aci_aifsn_bitmap;
251 cw_min = (1 << (ecw & MWIFIEX_ECW_MIN)) - 1;
252 avg_back_off = (cw_min >> 1) + (aci_aifsn & MWIFIEX_AIFSN);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700253
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700254 ac_idx = wmm_aci_to_qidx_map[(aci_aifsn & MWIFIEX_ACI) >> 5];
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700255 priv->wmm.queue_priority[ac_idx] = ac_idx;
256 tmp[ac_idx] = avg_back_off;
257
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700258 dev_dbg(priv->adapter->dev,
259 "info: WMM: CWmax=%d CWmin=%d Avg Back-off=%d\n",
260 (1 << ((ecw & MWIFIEX_ECW_MAX) >> 4)) - 1,
261 cw_min, avg_back_off);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700262 mwifiex_wmm_ac_debug_print(&wmm_ie->ac_params[num_ac]);
263 }
264
265 /* Bubble sort */
266 for (i = 0; i < num_ac; i++) {
267 for (j = 1; j < num_ac - i; j++) {
268 if (tmp[j - 1] > tmp[j]) {
269 swap(tmp[j - 1], tmp[j]);
270 swap(priv->wmm.queue_priority[j - 1],
271 priv->wmm.queue_priority[j]);
272 } else if (tmp[j - 1] == tmp[j]) {
273 if (priv->wmm.queue_priority[j - 1]
274 < priv->wmm.queue_priority[j])
275 swap(priv->wmm.queue_priority[j - 1],
276 priv->wmm.queue_priority[j]);
277 }
278 }
279 }
280
Avinash Patil41a24a22014-02-07 16:27:29 -0800281 mwifiex_wmm_queue_priorities_tid(priv);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700282}
283
284/*
285 * This function evaluates whether or not an AC is to be downgraded.
286 *
287 * In case the AC is not enabled, the highest AC is returned that is
288 * enabled and does not require admission control.
289 */
290static enum mwifiex_wmm_ac_e
291mwifiex_wmm_eval_downgrade_ac(struct mwifiex_private *priv,
292 enum mwifiex_wmm_ac_e eval_ac)
293{
294 int down_ac;
295 enum mwifiex_wmm_ac_e ret_ac;
296 struct mwifiex_wmm_ac_status *ac_status;
297
298 ac_status = &priv->wmm.ac_status[eval_ac];
299
300 if (!ac_status->disabled)
301 /* Okay to use this AC, its enabled */
302 return eval_ac;
303
304 /* Setup a default return value of the lowest priority */
305 ret_ac = WMM_AC_BK;
306
307 /*
308 * Find the highest AC that is enabled and does not require
309 * admission control. The spec disallows downgrading to an AC,
310 * which is enabled due to a completed admission control.
311 * Unadmitted traffic is not to be sent on an AC with admitted
312 * traffic.
313 */
314 for (down_ac = WMM_AC_BK; down_ac < eval_ac; down_ac++) {
315 ac_status = &priv->wmm.ac_status[down_ac];
316
317 if (!ac_status->disabled && !ac_status->flow_required)
318 /* AC is enabled and does not require admission
319 control */
320 ret_ac = (enum mwifiex_wmm_ac_e) down_ac;
321 }
322
323 return ret_ac;
324}
325
326/*
327 * This function downgrades WMM priority queue.
328 */
329void
330mwifiex_wmm_setup_ac_downgrade(struct mwifiex_private *priv)
331{
332 int ac_val;
333
334 dev_dbg(priv->adapter->dev, "info: WMM: AC Priorities:"
335 "BK(0), BE(1), VI(2), VO(3)\n");
336
337 if (!priv->wmm_enabled) {
338 /* WMM is not enabled, default priorities */
339 for (ac_val = WMM_AC_BK; ac_val <= WMM_AC_VO; ac_val++)
340 priv->wmm.ac_down_graded_vals[ac_val] =
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700341 (enum mwifiex_wmm_ac_e) ac_val;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700342 } else {
343 for (ac_val = WMM_AC_BK; ac_val <= WMM_AC_VO; ac_val++) {
344 priv->wmm.ac_down_graded_vals[ac_val]
345 = mwifiex_wmm_eval_downgrade_ac(priv,
346 (enum mwifiex_wmm_ac_e) ac_val);
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700347 dev_dbg(priv->adapter->dev,
348 "info: WMM: AC PRIO %d maps to %d\n",
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700349 ac_val, priv->wmm.ac_down_graded_vals[ac_val]);
350 }
351 }
352}
353
354/*
355 * This function converts the IP TOS field to an WMM AC
356 * Queue assignment.
357 */
358static enum mwifiex_wmm_ac_e
359mwifiex_wmm_convert_tos_to_ac(struct mwifiex_adapter *adapter, u32 tos)
360{
361 /* Map of TOS UP values to WMM AC */
362 const enum mwifiex_wmm_ac_e tos_to_ac[] = { WMM_AC_BE,
363 WMM_AC_BK,
364 WMM_AC_BK,
365 WMM_AC_BE,
366 WMM_AC_VI,
367 WMM_AC_VI,
368 WMM_AC_VO,
369 WMM_AC_VO
370 };
371
372 if (tos >= ARRAY_SIZE(tos_to_ac))
373 return WMM_AC_BE;
374
375 return tos_to_ac[tos];
376}
377
378/*
379 * This function evaluates a given TID and downgrades it to a lower
380 * TID if the WMM Parameter IE received from the AP indicates that the
381 * AP is disabled (due to call admission control (ACM bit). Mapping
382 * of TID to AC is taken care of internally.
383 */
Avinash Patil5f2caaf2014-02-07 16:27:33 -0800384u8 mwifiex_wmm_downgrade_tid(struct mwifiex_private *priv, u32 tid)
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700385{
386 enum mwifiex_wmm_ac_e ac, ac_down;
387 u8 new_tid;
388
389 ac = mwifiex_wmm_convert_tos_to_ac(priv->adapter, tid);
390 ac_down = priv->wmm.ac_down_graded_vals[ac];
391
392 /* Send the index to tid array, picking from the array will be
393 * taken care by dequeuing function
394 */
395 new_tid = ac_to_tid[ac_down][tid % 2];
396
397 return new_tid;
398}
399
400/*
401 * This function initializes the WMM state information and the
402 * WMM data path queues.
403 */
404void
405mwifiex_wmm_init(struct mwifiex_adapter *adapter)
406{
407 int i, j;
408 struct mwifiex_private *priv;
409
410 for (j = 0; j < adapter->priv_num; ++j) {
411 priv = adapter->priv[j];
412 if (!priv)
413 continue;
414
415 for (i = 0; i < MAX_NUM_TID; ++i) {
Amitkumar Karwar4c9f9fb2014-03-07 19:41:31 -0800416 if (!disable_tx_amsdu &&
417 adapter->tx_buf_size > MWIFIEX_TX_DATA_BUF_SIZE_2K)
418 priv->aggr_prio_tbl[i].amsdu =
419 priv->tos_to_tid_inv[i];
420 else
421 priv->aggr_prio_tbl[i].amsdu =
422 BA_STREAM_NOT_ALLOWED;
Avinash Patil41a24a22014-02-07 16:27:29 -0800423 priv->aggr_prio_tbl[i].ampdu_ap =
424 priv->tos_to_tid_inv[i];
425 priv->aggr_prio_tbl[i].ampdu_user =
426 priv->tos_to_tid_inv[i];
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700427 }
428
Avinash Patil04abc0a2013-03-27 19:10:31 -0700429 mwifiex_set_ba_params(priv);
Stone Piao92583922012-06-20 20:21:10 -0700430 mwifiex_reset_11n_rx_seq_num(priv);
431
Marc Yangf6992542011-05-16 19:17:49 -0700432 atomic_set(&priv->wmm.tx_pkts_queued, 0);
Marc Yang49729ff2011-05-16 19:17:50 -0700433 atomic_set(&priv->wmm.highest_queued_prio, HIGH_PRIO_TID);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700434 }
435}
436
437/*
438 * This function checks if WMM Tx queue is empty.
439 */
440int
441mwifiex_wmm_lists_empty(struct mwifiex_adapter *adapter)
442{
Marc Yangf6992542011-05-16 19:17:49 -0700443 int i;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700444 struct mwifiex_private *priv;
445
Marc Yangf6992542011-05-16 19:17:49 -0700446 for (i = 0; i < adapter->priv_num; ++i) {
447 priv = adapter->priv[i];
448 if (priv && atomic_read(&priv->wmm.tx_pkts_queued))
Stone Piaoa8aa69d2012-09-25 20:23:31 -0700449 return false;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700450 }
451
452 return true;
453}
454
455/*
456 * This function deletes all packets in an RA list node.
457 *
458 * The packet sent completion callback handler are called with
459 * status failure, after they are dequeued to ensure proper
460 * cleanup. The RA list node itself is freed at the end.
461 */
462static void
463mwifiex_wmm_del_pkts_in_ralist_node(struct mwifiex_private *priv,
464 struct mwifiex_ra_list_tbl *ra_list)
465{
466 struct mwifiex_adapter *adapter = priv->adapter;
467 struct sk_buff *skb, *tmp;
468
469 skb_queue_walk_safe(&ra_list->skb_head, skb, tmp)
Avinash Patil47411a02012-11-01 18:44:16 -0700470 mwifiex_write_data_complete(adapter, skb, 0, -1);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700471}
472
473/*
474 * This function deletes all packets in an RA list.
475 *
476 * Each nodes in the RA list are freed individually first, and then
477 * the RA list itself is freed.
478 */
479static void
480mwifiex_wmm_del_pkts_in_ralist(struct mwifiex_private *priv,
481 struct list_head *ra_list_head)
482{
483 struct mwifiex_ra_list_tbl *ra_list;
484
485 list_for_each_entry(ra_list, ra_list_head, list)
486 mwifiex_wmm_del_pkts_in_ralist_node(priv, ra_list);
487}
488
489/*
490 * This function deletes all packets in all RA lists.
491 */
492static void mwifiex_wmm_cleanup_queues(struct mwifiex_private *priv)
493{
494 int i;
495
496 for (i = 0; i < MAX_NUM_TID; i++)
497 mwifiex_wmm_del_pkts_in_ralist(priv, &priv->wmm.tid_tbl_ptr[i].
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700498 ra_list);
Marc Yangf6992542011-05-16 19:17:49 -0700499
500 atomic_set(&priv->wmm.tx_pkts_queued, 0);
Marc Yang49729ff2011-05-16 19:17:50 -0700501 atomic_set(&priv->wmm.highest_queued_prio, HIGH_PRIO_TID);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700502}
503
504/*
505 * This function deletes all route addresses from all RA lists.
506 */
507static void mwifiex_wmm_delete_all_ralist(struct mwifiex_private *priv)
508{
509 struct mwifiex_ra_list_tbl *ra_list, *tmp_node;
510 int i;
511
512 for (i = 0; i < MAX_NUM_TID; ++i) {
513 dev_dbg(priv->adapter->dev,
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700514 "info: ra_list: freeing buf for tid %d\n", i);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700515 list_for_each_entry_safe(ra_list, tmp_node,
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700516 &priv->wmm.tid_tbl_ptr[i].ra_list,
517 list) {
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700518 list_del(&ra_list->list);
519 kfree(ra_list);
520 }
521
522 INIT_LIST_HEAD(&priv->wmm.tid_tbl_ptr[i].ra_list);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700523 }
524}
525
Amitkumar Karwar808bbeb2014-11-25 06:43:05 -0800526static int mwifiex_free_ack_frame(int id, void *p, void *data)
527{
528 pr_warn("Have pending ack frames!\n");
529 kfree_skb(p);
530 return 0;
531}
532
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700533/*
534 * This function cleans up the Tx and Rx queues.
535 *
536 * Cleanup includes -
537 * - All packets in RA lists
538 * - All entries in Rx reorder table
539 * - All entries in Tx BA stream table
540 * - MPA buffer (if required)
541 * - All RA lists
542 */
543void
544mwifiex_clean_txrx(struct mwifiex_private *priv)
545{
546 unsigned long flags;
Avinash Patil56bd24a2014-02-07 16:30:35 -0800547 struct sk_buff *skb, *tmp;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700548
549 mwifiex_11n_cleanup_reorder_tbl(priv);
550 spin_lock_irqsave(&priv->wmm.ra_list_spinlock, flags);
551
552 mwifiex_wmm_cleanup_queues(priv);
553 mwifiex_11n_delete_all_tx_ba_stream_tbl(priv);
554
555 if (priv->adapter->if_ops.cleanup_mpa_buf)
556 priv->adapter->if_ops.cleanup_mpa_buf(priv->adapter);
557
558 mwifiex_wmm_delete_all_ralist(priv);
559 memcpy(tos_to_tid, ac_to_tid, sizeof(tos_to_tid));
560
Avinash Patil4f7ba432014-02-18 15:41:54 -0800561 if (priv->adapter->if_ops.clean_pcie_ring &&
562 !priv->adapter->surprise_removed)
Avinash Patilfbd7e7a2013-01-03 21:21:31 -0800563 priv->adapter->if_ops.clean_pcie_ring(priv->adapter);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700564 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock, flags);
Avinash Patil56bd24a2014-02-07 16:30:35 -0800565
566 skb_queue_walk_safe(&priv->tdls_txq, skb, tmp)
567 mwifiex_write_data_complete(priv->adapter, skb, 0, -1);
Amitkumar Karwar808bbeb2014-11-25 06:43:05 -0800568
569 idr_for_each(&priv->ack_status_frames, mwifiex_free_ack_frame, NULL);
570 idr_destroy(&priv->ack_status_frames);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700571}
572
573/*
574 * This function retrieves a particular RA list node, matching with the
575 * given TID and RA address.
576 */
577static struct mwifiex_ra_list_tbl *
578mwifiex_wmm_get_ralist_node(struct mwifiex_private *priv, u8 tid,
Johannes Berg3b3a0162014-05-19 17:19:31 +0200579 const u8 *ra_addr)
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700580{
581 struct mwifiex_ra_list_tbl *ra_list;
582
583 list_for_each_entry(ra_list, &priv->wmm.tid_tbl_ptr[tid].ra_list,
584 list) {
585 if (!memcmp(ra_list->ra, ra_addr, ETH_ALEN))
586 return ra_list;
587 }
588
589 return NULL;
590}
591
592/*
593 * This function retrieves an RA list node for a given TID and
594 * RA address pair.
595 *
596 * If no such node is found, a new node is added first and then
597 * retrieved.
598 */
Avinash Patil5f2caaf2014-02-07 16:27:33 -0800599struct mwifiex_ra_list_tbl *
Johannes Berg3b3a0162014-05-19 17:19:31 +0200600mwifiex_wmm_get_queue_raptr(struct mwifiex_private *priv, u8 tid,
601 const u8 *ra_addr)
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700602{
603 struct mwifiex_ra_list_tbl *ra_list;
604
605 ra_list = mwifiex_wmm_get_ralist_node(priv, tid, ra_addr);
606 if (ra_list)
607 return ra_list;
608 mwifiex_ralist_add(priv, ra_addr);
609
610 return mwifiex_wmm_get_ralist_node(priv, tid, ra_addr);
611}
612
613/*
Avinash Patil9817fff2014-12-05 23:23:40 +0530614 * This function deletes RA list nodes for given mac for all TIDs.
615 * Function also decrements TX pending count accordingly.
616 */
617void
618mwifiex_wmm_del_peer_ra_list(struct mwifiex_private *priv, const u8 *ra_addr)
619{
620 struct mwifiex_ra_list_tbl *ra_list;
621 unsigned long flags;
622 int i;
623
624 spin_lock_irqsave(&priv->wmm.ra_list_spinlock, flags);
625
626 for (i = 0; i < MAX_NUM_TID; ++i) {
627 ra_list = mwifiex_wmm_get_ralist_node(priv, i, ra_addr);
628
629 if (!ra_list)
630 continue;
631 mwifiex_wmm_del_pkts_in_ralist_node(priv, ra_list);
632 atomic_sub(ra_list->total_pkt_count, &priv->wmm.tx_pkts_queued);
633 list_del(&ra_list->list);
634 kfree(ra_list);
635 }
636 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock, flags);
637}
638
639/*
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700640 * This function checks if a particular RA list node exists in a given TID
641 * table index.
642 */
643int
644mwifiex_is_ralist_valid(struct mwifiex_private *priv,
645 struct mwifiex_ra_list_tbl *ra_list, int ptr_index)
646{
647 struct mwifiex_ra_list_tbl *rlist;
648
649 list_for_each_entry(rlist, &priv->wmm.tid_tbl_ptr[ptr_index].ra_list,
650 list) {
651 if (rlist == ra_list)
652 return true;
653 }
654
655 return false;
656}
657
658/*
659 * This function adds a packet to WMM queue.
660 *
661 * In disconnected state the packet is immediately dropped and the
662 * packet send completion callback is called with status failure.
663 *
664 * Otherwise, the correct RA list node is located and the packet
665 * is queued at the list tail.
666 */
667void
Avinash Patil2690e1b2012-01-24 20:50:24 -0800668mwifiex_wmm_add_buf_txqueue(struct mwifiex_private *priv,
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700669 struct sk_buff *skb)
670{
Avinash Patil2690e1b2012-01-24 20:50:24 -0800671 struct mwifiex_adapter *adapter = priv->adapter;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700672 u32 tid;
673 struct mwifiex_ra_list_tbl *ra_list;
674 u8 ra[ETH_ALEN], tid_down;
675 unsigned long flags;
Avinash Patild63bf5e2014-02-07 16:30:36 -0800676 struct list_head list_head;
677 int tdls_status = TDLS_NOT_SETUP;
678 struct ethhdr *eth_hdr = (struct ethhdr *)skb->data;
679 struct mwifiex_txinfo *tx_info = MWIFIEX_SKB_TXCB(skb);
680
681 memcpy(ra, eth_hdr->h_dest, ETH_ALEN);
682
683 if (GET_BSS_ROLE(priv) == MWIFIEX_BSS_ROLE_STA &&
684 ISSUPP_TDLS_ENABLED(adapter->fw_cap_info)) {
685 if (ntohs(eth_hdr->h_proto) == ETH_P_TDLS)
686 dev_dbg(adapter->dev,
687 "TDLS setup packet for %pM. Don't block\n", ra);
Avinash Patil16e85522014-05-21 22:02:27 -0700688 else if (memcmp(priv->cfg_bssid, ra, ETH_ALEN))
Avinash Patild63bf5e2014-02-07 16:30:36 -0800689 tdls_status = mwifiex_get_tdls_link_status(priv, ra);
690 }
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700691
Stone Piaoe39faa72012-09-25 20:23:32 -0700692 if (!priv->media_connected && !mwifiex_is_skb_mgmt_frame(skb)) {
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700693 dev_dbg(adapter->dev, "data: drop packet in disconnect\n");
Avinash Patil47411a02012-11-01 18:44:16 -0700694 mwifiex_write_data_complete(adapter, skb, 0, -1);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700695 return;
696 }
697
698 tid = skb->priority;
699
700 spin_lock_irqsave(&priv->wmm.ra_list_spinlock, flags);
701
702 tid_down = mwifiex_wmm_downgrade_tid(priv, tid);
703
704 /* In case of infra as we have already created the list during
705 association we just don't have to call get_queue_raptr, we will
706 have only 1 raptr for a tid in case of infra */
Stone Piaoe39faa72012-09-25 20:23:32 -0700707 if (!mwifiex_queuing_ra_based(priv) &&
708 !mwifiex_is_skb_mgmt_frame(skb)) {
Avinash Patild63bf5e2014-02-07 16:30:36 -0800709 switch (tdls_status) {
710 case TDLS_SETUP_COMPLETE:
711 ra_list = mwifiex_wmm_get_queue_raptr(priv, tid_down,
712 ra);
713 tx_info->flags |= MWIFIEX_BUF_FLAG_TDLS_PKT;
714 break;
715 case TDLS_SETUP_INPROGRESS:
716 skb_queue_tail(&priv->tdls_txq, skb);
717 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock,
718 flags);
719 return;
720 default:
721 list_head = priv->wmm.tid_tbl_ptr[tid_down].ra_list;
722 if (!list_empty(&list_head))
723 ra_list = list_first_entry(
724 &list_head, struct mwifiex_ra_list_tbl,
725 list);
726 else
727 ra_list = NULL;
728 break;
729 }
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700730 } else {
731 memcpy(ra, skb->data, ETH_ALEN);
Stone Piaoe39faa72012-09-25 20:23:32 -0700732 if (ra[0] & 0x01 || mwifiex_is_skb_mgmt_frame(skb))
Amitkumar Karwar4e3c4422011-07-13 20:51:57 -0700733 memset(ra, 0xff, ETH_ALEN);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700734 ra_list = mwifiex_wmm_get_queue_raptr(priv, tid_down, ra);
735 }
736
737 if (!ra_list) {
738 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock, flags);
Avinash Patil47411a02012-11-01 18:44:16 -0700739 mwifiex_write_data_complete(adapter, skb, 0, -1);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700740 return;
741 }
742
743 skb_queue_tail(&ra_list->skb_head, skb);
744
Avinash Patilf0cb84f2013-07-22 19:17:39 -0700745 ra_list->ba_pkt_count++;
Avinash Patilc7d9ed92013-07-22 19:17:40 -0700746 ra_list->total_pkt_count++;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700747
Marc Yang49729ff2011-05-16 19:17:50 -0700748 if (atomic_read(&priv->wmm.highest_queued_prio) <
Avinash Patil41a24a22014-02-07 16:27:29 -0800749 priv->tos_to_tid_inv[tid_down])
Marc Yang49729ff2011-05-16 19:17:50 -0700750 atomic_set(&priv->wmm.highest_queued_prio,
Avinash Patil41a24a22014-02-07 16:27:29 -0800751 priv->tos_to_tid_inv[tid_down]);
Marc Yang49729ff2011-05-16 19:17:50 -0700752
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700753 atomic_inc(&priv->wmm.tx_pkts_queued);
754
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700755 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock, flags);
756}
757
758/*
759 * This function processes the get WMM status command response from firmware.
760 *
761 * The response may contain multiple TLVs -
762 * - AC Queue status TLVs
763 * - Current WMM Parameter IE TLV
764 * - Admission Control action frame TLVs
765 *
766 * This function parses the TLVs and then calls further specific functions
767 * to process any changes in the queue prioritize or state.
768 */
769int mwifiex_ret_wmm_get_status(struct mwifiex_private *priv,
770 const struct host_cmd_ds_command *resp)
771{
772 u8 *curr = (u8 *) &resp->params.get_wmm_status;
773 uint16_t resp_len = le16_to_cpu(resp->size), tlv_len;
Peter Senna Tschudinc8561972013-09-22 00:27:43 +0200774 bool valid = true;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700775
776 struct mwifiex_ie_types_data *tlv_hdr;
777 struct mwifiex_ie_types_wmm_queue_status *tlv_wmm_qstatus;
778 struct ieee_types_wmm_parameter *wmm_param_ie = NULL;
779 struct mwifiex_wmm_ac_status *ac_status;
780
781 dev_dbg(priv->adapter->dev, "info: WMM: WMM_GET_STATUS cmdresp received: %d\n",
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700782 resp_len);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700783
784 while ((resp_len >= sizeof(tlv_hdr->header)) && valid) {
785 tlv_hdr = (struct mwifiex_ie_types_data *) curr;
786 tlv_len = le16_to_cpu(tlv_hdr->header.len);
787
Dan Carpenter95edbc32013-10-22 15:24:42 -0700788 if (resp_len < tlv_len + sizeof(tlv_hdr->header))
789 break;
790
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700791 switch (le16_to_cpu(tlv_hdr->header.type)) {
792 case TLV_TYPE_WMMQSTATUS:
793 tlv_wmm_qstatus =
794 (struct mwifiex_ie_types_wmm_queue_status *)
795 tlv_hdr;
796 dev_dbg(priv->adapter->dev,
797 "info: CMD_RESP: WMM_GET_STATUS:"
798 " QSTATUS TLV: %d, %d, %d\n",
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700799 tlv_wmm_qstatus->queue_index,
800 tlv_wmm_qstatus->flow_required,
801 tlv_wmm_qstatus->disabled);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700802
803 ac_status = &priv->wmm.ac_status[tlv_wmm_qstatus->
804 queue_index];
805 ac_status->disabled = tlv_wmm_qstatus->disabled;
806 ac_status->flow_required =
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700807 tlv_wmm_qstatus->flow_required;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700808 ac_status->flow_created = tlv_wmm_qstatus->flow_created;
809 break;
810
811 case WLAN_EID_VENDOR_SPECIFIC:
812 /*
813 * Point the regular IEEE IE 2 bytes into the Marvell IE
814 * and setup the IEEE IE type and length byte fields
815 */
816
817 wmm_param_ie =
818 (struct ieee_types_wmm_parameter *) (curr +
819 2);
820 wmm_param_ie->vend_hdr.len = (u8) tlv_len;
821 wmm_param_ie->vend_hdr.element_id =
822 WLAN_EID_VENDOR_SPECIFIC;
823
824 dev_dbg(priv->adapter->dev,
825 "info: CMD_RESP: WMM_GET_STATUS:"
826 " WMM Parameter Set Count: %d\n",
827 wmm_param_ie->qos_info_bitmap &
828 IEEE80211_WMM_IE_AP_QOSINFO_PARAM_SET_CNT_MASK);
829
830 memcpy((u8 *) &priv->curr_bss_params.bss_descriptor.
831 wmm_ie, wmm_param_ie,
832 wmm_param_ie->vend_hdr.len + 2);
833
834 break;
835
836 default:
837 valid = false;
838 break;
839 }
840
841 curr += (tlv_len + sizeof(tlv_hdr->header));
842 resp_len -= (tlv_len + sizeof(tlv_hdr->header));
843 }
844
845 mwifiex_wmm_setup_queue_priorities(priv, wmm_param_ie);
846 mwifiex_wmm_setup_ac_downgrade(priv);
847
848 return 0;
849}
850
851/*
852 * Callback handler from the command module to allow insertion of a WMM TLV.
853 *
854 * If the BSS we are associating to supports WMM, this function adds the
855 * required WMM Information IE to the association request command buffer in
856 * the form of a Marvell extended IEEE IE.
857 */
858u32
859mwifiex_wmm_process_association_req(struct mwifiex_private *priv,
860 u8 **assoc_buf,
861 struct ieee_types_wmm_parameter *wmm_ie,
862 struct ieee80211_ht_cap *ht_cap)
863{
864 struct mwifiex_ie_types_wmm_param_set *wmm_tlv;
865 u32 ret_len = 0;
866
867 /* Null checks */
868 if (!assoc_buf)
869 return 0;
870 if (!(*assoc_buf))
871 return 0;
872
873 if (!wmm_ie)
874 return 0;
875
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700876 dev_dbg(priv->adapter->dev,
877 "info: WMM: process assoc req: bss->wmm_ie=%#x\n",
878 wmm_ie->vend_hdr.element_id);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700879
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700880 if ((priv->wmm_required ||
881 (ht_cap && (priv->adapter->config_bands & BAND_GN ||
882 priv->adapter->config_bands & BAND_AN))) &&
883 wmm_ie->vend_hdr.element_id == WLAN_EID_VENDOR_SPECIFIC) {
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700884 wmm_tlv = (struct mwifiex_ie_types_wmm_param_set *) *assoc_buf;
885 wmm_tlv->header.type = cpu_to_le16((u16) wmm_info_ie[0]);
886 wmm_tlv->header.len = cpu_to_le16((u16) wmm_info_ie[1]);
887 memcpy(wmm_tlv->wmm_ie, &wmm_info_ie[2],
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700888 le16_to_cpu(wmm_tlv->header.len));
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700889 if (wmm_ie->qos_info_bitmap & IEEE80211_WMM_IE_AP_QOSINFO_UAPSD)
890 memcpy((u8 *) (wmm_tlv->wmm_ie
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700891 + le16_to_cpu(wmm_tlv->header.len)
892 - sizeof(priv->wmm_qosinfo)),
893 &priv->wmm_qosinfo, sizeof(priv->wmm_qosinfo));
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700894
895 ret_len = sizeof(wmm_tlv->header)
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700896 + le16_to_cpu(wmm_tlv->header.len);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700897
898 *assoc_buf += ret_len;
899 }
900
901 return ret_len;
902}
903
904/*
905 * This function computes the time delay in the driver queues for a
906 * given packet.
907 *
908 * When the packet is received at the OS/Driver interface, the current
909 * time is set in the packet structure. The difference between the present
910 * time and that received time is computed in this function and limited
911 * based on pre-compiled limits in the driver.
912 */
913u8
914mwifiex_wmm_compute_drv_pkt_delay(struct mwifiex_private *priv,
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -0700915 const struct sk_buff *skb)
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700916{
Thomas Gleixnerc64800e2014-06-12 08:31:34 +0100917 u32 queue_delay = ktime_to_ms(net_timedelta(skb->tstamp));
Yogesh Ashok Powar270e58e2011-05-03 20:11:46 -0700918 u8 ret_val;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700919
920 /*
921 * Queue delay is passed as a uint8 in units of 2ms (ms shifted
922 * by 1). Min value (other than 0) is therefore 2ms, max is 510ms.
923 *
924 * Pass max value if queue_delay is beyond the uint8 range
925 */
926 ret_val = (u8) (min(queue_delay, priv->wmm.drv_pkt_delay_max) >> 1);
927
928 dev_dbg(priv->adapter->dev, "data: WMM: Pkt Delay: %d ms,"
929 " %d ms sent to FW\n", queue_delay, ret_val);
930
931 return ret_val;
932}
933
934/*
935 * This function retrieves the highest priority RA list table pointer.
936 */
937static struct mwifiex_ra_list_tbl *
938mwifiex_wmm_get_highest_priolist_ptr(struct mwifiex_adapter *adapter,
939 struct mwifiex_private **priv, int *tid)
940{
941 struct mwifiex_private *priv_tmp;
Andreas Fenkart2e237312013-04-18 16:33:45 -0700942 struct mwifiex_ra_list_tbl *ptr;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700943 struct mwifiex_tid_tbl *tid_ptr;
Yogesh Ashok Powarbb7de2b2012-03-12 19:35:12 -0700944 atomic_t *hqp;
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700945 unsigned long flags_bss, flags_ra;
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700946 int i, j;
947
Andreas Fenkartb006ed52013-04-18 16:34:12 -0700948 /* check the BSS with highest priority first */
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700949 for (j = adapter->priv_num - 1; j >= 0; --j) {
950 spin_lock_irqsave(&adapter->bss_prio_tbl[j].bss_prio_lock,
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700951 flags_bss);
952
Andreas Fenkartb006ed52013-04-18 16:34:12 -0700953 /* iterate over BSS with the equal priority */
954 list_for_each_entry(adapter->bss_prio_tbl[j].bss_prio_cur,
955 &adapter->bss_prio_tbl[j].bss_prio_head,
956 list) {
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700957
Andreas Fenkartb006ed52013-04-18 16:34:12 -0700958 priv_tmp = adapter->bss_prio_tbl[j].bss_prio_cur->priv;
Marc Yang49729ff2011-05-16 19:17:50 -0700959
Andreas Fenkart333f6b22013-04-04 20:03:52 -0700960 if (atomic_read(&priv_tmp->wmm.tx_pkts_queued) == 0)
Andreas Fenkartb006ed52013-04-18 16:34:12 -0700961 continue;
Andreas Fenkart333f6b22013-04-04 20:03:52 -0700962
963 /* iterate over the WMM queues of the BSS */
964 hqp = &priv_tmp->wmm.highest_queued_prio;
Marc Yang49729ff2011-05-16 19:17:50 -0700965 for (i = atomic_read(hqp); i >= LOW_PRIO_TID; --i) {
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700966
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700967 spin_lock_irqsave(&priv_tmp->wmm.
968 ra_list_spinlock, flags_ra);
969
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700970 tid_ptr = &(priv_tmp)->wmm.
971 tid_tbl_ptr[tos_to_tid[i]];
972
Andreas Fenkart2e237312013-04-18 16:33:45 -0700973 /* iterate over receiver addresses */
974 list_for_each_entry(ptr, &tid_ptr->ra_list,
975 list) {
Avinash Patil64b05e22012-05-08 18:30:13 -0700976
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700977 if (!skb_queue_empty(&ptr->skb_head))
978 /* holds both locks */
Yogesh Ashok Powarbb7de2b2012-03-12 19:35:12 -0700979 goto found;
Andreas Fenkart2e237312013-04-18 16:33:45 -0700980 }
Yogesh Ashok Powarbb7de2b2012-03-12 19:35:12 -0700981
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700982 spin_unlock_irqrestore(&priv_tmp->wmm.
983 ra_list_spinlock,
984 flags_ra);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700985 }
Andreas Fenkartb006ed52013-04-18 16:34:12 -0700986 }
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700987
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700988 spin_unlock_irqrestore(&adapter->bss_prio_tbl[j].bss_prio_lock,
989 flags_bss);
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700990 }
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700991
Bing Zhao5e6e3a92011-03-21 18:00:50 -0700992 return NULL;
Yogesh Ashok Powarbb7de2b2012-03-12 19:35:12 -0700993
994found:
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700995 /* holds bss_prio_lock / ra_list_spinlock */
Yogesh Ashok Powarbb7de2b2012-03-12 19:35:12 -0700996 if (atomic_read(hqp) > i)
997 atomic_set(hqp, i);
Andreas Fenkart2716fd72013-04-04 20:03:53 -0700998 spin_unlock_irqrestore(&priv_tmp->wmm.ra_list_spinlock, flags_ra);
999 spin_unlock_irqrestore(&adapter->bss_prio_tbl[j].bss_prio_lock,
1000 flags_bss);
Yogesh Ashok Powarbb7de2b2012-03-12 19:35:12 -07001001
1002 *priv = priv_tmp;
1003 *tid = tos_to_tid[i];
1004
1005 return ptr;
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001006}
1007
Andreas Fenkartb006ed52013-04-18 16:34:12 -07001008/* This functions rotates ra and bss lists so packets are picked round robin.
Andreas Fenkart2e237312013-04-18 16:33:45 -07001009 *
1010 * After a packet is successfully transmitted, rotate the ra list, so the ra
1011 * next to the one transmitted, will come first in the list. This way we pick
Andreas Fenkartb006ed52013-04-18 16:34:12 -07001012 * the ra' in a round robin fashion. Same applies to bss nodes of equal
1013 * priority.
Andreas Fenkart2e237312013-04-18 16:33:45 -07001014 *
1015 * Function also increments wmm.packets_out counter.
1016 */
1017void mwifiex_rotate_priolists(struct mwifiex_private *priv,
1018 struct mwifiex_ra_list_tbl *ra,
1019 int tid)
1020{
Andreas Fenkartb006ed52013-04-18 16:34:12 -07001021 struct mwifiex_adapter *adapter = priv->adapter;
1022 struct mwifiex_bss_prio_tbl *tbl = adapter->bss_prio_tbl;
Andreas Fenkart2e237312013-04-18 16:33:45 -07001023 struct mwifiex_tid_tbl *tid_ptr = &priv->wmm.tid_tbl_ptr[tid];
1024 unsigned long flags;
1025
Andreas Fenkartb006ed52013-04-18 16:34:12 -07001026 spin_lock_irqsave(&tbl[priv->bss_priority].bss_prio_lock, flags);
1027 /*
1028 * dirty trick: we remove 'head' temporarily and reinsert it after
1029 * curr bss node. imagine list to stay fixed while head is moved
1030 */
1031 list_move(&tbl[priv->bss_priority].bss_prio_head,
1032 &tbl[priv->bss_priority].bss_prio_cur->list);
1033 spin_unlock_irqrestore(&tbl[priv->bss_priority].bss_prio_lock, flags);
1034
Andreas Fenkart2e237312013-04-18 16:33:45 -07001035 spin_lock_irqsave(&priv->wmm.ra_list_spinlock, flags);
1036 if (mwifiex_is_ralist_valid(priv, ra, tid)) {
1037 priv->wmm.packets_out[tid]++;
Andreas Fenkartb006ed52013-04-18 16:34:12 -07001038 /* same as above */
Andreas Fenkart2e237312013-04-18 16:33:45 -07001039 list_move(&tid_ptr->ra_list, &ra->list);
1040 }
1041 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock, flags);
1042}
1043
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001044/*
Amitkumar Karward85c5fe2011-09-29 20:43:40 -07001045 * This function checks if 11n aggregation is possible.
1046 */
1047static int
1048mwifiex_is_11n_aggragation_possible(struct mwifiex_private *priv,
1049 struct mwifiex_ra_list_tbl *ptr,
1050 int max_buf_size)
1051{
1052 int count = 0, total_size = 0;
1053 struct sk_buff *skb, *tmp;
Avinash Patil5a009ad2012-08-03 18:06:10 -07001054 int max_amsdu_size;
1055
1056 if (priv->bss_role == MWIFIEX_BSS_ROLE_UAP && priv->ap_11n_enabled &&
1057 ptr->is_11n_enabled)
1058 max_amsdu_size = min_t(int, ptr->max_amsdu, max_buf_size);
1059 else
1060 max_amsdu_size = max_buf_size;
Amitkumar Karward85c5fe2011-09-29 20:43:40 -07001061
1062 skb_queue_walk_safe(&ptr->skb_head, skb, tmp) {
1063 total_size += skb->len;
Avinash Patil5a009ad2012-08-03 18:06:10 -07001064 if (total_size >= max_amsdu_size)
Amitkumar Karward85c5fe2011-09-29 20:43:40 -07001065 break;
1066 if (++count >= MIN_NUM_AMSDU)
1067 return true;
1068 }
1069
1070 return false;
1071}
1072
1073/*
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001074 * This function sends a single packet to firmware for transmission.
1075 */
1076static void
1077mwifiex_send_single_packet(struct mwifiex_private *priv,
1078 struct mwifiex_ra_list_tbl *ptr, int ptr_index,
1079 unsigned long ra_list_flags)
1080 __releases(&priv->wmm.ra_list_spinlock)
1081{
1082 struct sk_buff *skb, *skb_next;
1083 struct mwifiex_tx_param tx_param;
1084 struct mwifiex_adapter *adapter = priv->adapter;
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001085 struct mwifiex_txinfo *tx_info;
1086
1087 if (skb_queue_empty(&ptr->skb_head)) {
1088 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock,
1089 ra_list_flags);
1090 dev_dbg(adapter->dev, "data: nothing to send\n");
1091 return;
1092 }
1093
1094 skb = skb_dequeue(&ptr->skb_head);
1095
1096 tx_info = MWIFIEX_SKB_TXCB(skb);
1097 dev_dbg(adapter->dev, "data: dequeuing the packet %p %p\n", ptr, skb);
1098
Avinash Patilc7d9ed92013-07-22 19:17:40 -07001099 ptr->total_pkt_count--;
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001100
1101 if (!skb_queue_empty(&ptr->skb_head))
1102 skb_next = skb_peek(&ptr->skb_head);
1103 else
1104 skb_next = NULL;
1105
1106 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock, ra_list_flags);
1107
1108 tx_param.next_pkt_len = ((skb_next) ? skb_next->len +
1109 sizeof(struct txpd) : 0);
1110
Yogesh Ashok Powar636c4592011-04-15 20:50:40 -07001111 if (mwifiex_process_tx(priv, skb, &tx_param) == -EBUSY) {
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001112 /* Queue the packet back at the head */
1113 spin_lock_irqsave(&priv->wmm.ra_list_spinlock, ra_list_flags);
1114
1115 if (!mwifiex_is_ralist_valid(priv, ptr, ptr_index)) {
1116 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock,
1117 ra_list_flags);
Avinash Patil47411a02012-11-01 18:44:16 -07001118 mwifiex_write_data_complete(adapter, skb, 0, -1);
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001119 return;
1120 }
1121
1122 skb_queue_tail(&ptr->skb_head, skb);
1123
Avinash Patilc7d9ed92013-07-22 19:17:40 -07001124 ptr->total_pkt_count++;
Avinash Patilf0cb84f2013-07-22 19:17:39 -07001125 ptr->ba_pkt_count++;
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001126 tx_info->flags |= MWIFIEX_BUF_FLAG_REQUEUED_PKT;
1127 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock,
1128 ra_list_flags);
1129 } else {
Andreas Fenkart2e237312013-04-18 16:33:45 -07001130 mwifiex_rotate_priolists(priv, ptr, ptr_index);
Marc Yangf6992542011-05-16 19:17:49 -07001131 atomic_dec(&priv->wmm.tx_pkts_queued);
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001132 }
1133}
1134
1135/*
1136 * This function checks if the first packet in the given RA list
1137 * is already processed or not.
1138 */
1139static int
1140mwifiex_is_ptr_processed(struct mwifiex_private *priv,
1141 struct mwifiex_ra_list_tbl *ptr)
1142{
1143 struct sk_buff *skb;
1144 struct mwifiex_txinfo *tx_info;
1145
1146 if (skb_queue_empty(&ptr->skb_head))
1147 return false;
1148
1149 skb = skb_peek(&ptr->skb_head);
1150
1151 tx_info = MWIFIEX_SKB_TXCB(skb);
1152 if (tx_info->flags & MWIFIEX_BUF_FLAG_REQUEUED_PKT)
1153 return true;
1154
1155 return false;
1156}
1157
1158/*
1159 * This function sends a single processed packet to firmware for
1160 * transmission.
1161 */
1162static void
1163mwifiex_send_processed_packet(struct mwifiex_private *priv,
1164 struct mwifiex_ra_list_tbl *ptr, int ptr_index,
1165 unsigned long ra_list_flags)
1166 __releases(&priv->wmm.ra_list_spinlock)
1167{
1168 struct mwifiex_tx_param tx_param;
1169 struct mwifiex_adapter *adapter = priv->adapter;
1170 int ret = -1;
1171 struct sk_buff *skb, *skb_next;
1172 struct mwifiex_txinfo *tx_info;
1173
1174 if (skb_queue_empty(&ptr->skb_head)) {
1175 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock,
1176 ra_list_flags);
1177 return;
1178 }
1179
1180 skb = skb_dequeue(&ptr->skb_head);
1181
1182 if (!skb_queue_empty(&ptr->skb_head))
1183 skb_next = skb_peek(&ptr->skb_head);
1184 else
1185 skb_next = NULL;
1186
1187 tx_info = MWIFIEX_SKB_TXCB(skb);
1188
1189 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock, ra_list_flags);
Amitkumar Karwar4daffe32012-04-18 20:08:28 -07001190
1191 if (adapter->iface_type == MWIFIEX_USB) {
1192 adapter->data_sent = true;
1193 ret = adapter->if_ops.host_to_card(adapter, MWIFIEX_USB_EP_DATA,
1194 skb, NULL);
1195 } else {
1196 tx_param.next_pkt_len =
1197 ((skb_next) ? skb_next->len +
1198 sizeof(struct txpd) : 0);
1199 ret = adapter->if_ops.host_to_card(adapter, MWIFIEX_TYPE_DATA,
1200 skb, &tx_param);
1201 }
1202
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001203 switch (ret) {
1204 case -EBUSY:
1205 dev_dbg(adapter->dev, "data: -EBUSY is returned\n");
1206 spin_lock_irqsave(&priv->wmm.ra_list_spinlock, ra_list_flags);
1207
1208 if (!mwifiex_is_ralist_valid(priv, ptr, ptr_index)) {
1209 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock,
1210 ra_list_flags);
Avinash Patil47411a02012-11-01 18:44:16 -07001211 mwifiex_write_data_complete(adapter, skb, 0, -1);
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001212 return;
1213 }
1214
1215 skb_queue_tail(&ptr->skb_head, skb);
1216
1217 tx_info->flags |= MWIFIEX_BUF_FLAG_REQUEUED_PKT;
1218 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock,
1219 ra_list_flags);
1220 break;
1221 case -1:
Avinash Patile7f767a2013-01-03 21:21:32 -08001222 if (adapter->iface_type != MWIFIEX_PCIE)
1223 adapter->data_sent = false;
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001224 dev_err(adapter->dev, "host_to_card failed: %#x\n", ret);
1225 adapter->dbg.num_tx_host_to_card_failure++;
Avinash Patil47411a02012-11-01 18:44:16 -07001226 mwifiex_write_data_complete(adapter, skb, 0, ret);
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001227 break;
1228 case -EINPROGRESS:
Avinash Patile7f767a2013-01-03 21:21:32 -08001229 if (adapter->iface_type != MWIFIEX_PCIE)
1230 adapter->data_sent = false;
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001231 default:
1232 break;
1233 }
1234 if (ret != -EBUSY) {
Andreas Fenkart2e237312013-04-18 16:33:45 -07001235 mwifiex_rotate_priolists(priv, ptr, ptr_index);
Marc Yangf6992542011-05-16 19:17:49 -07001236 atomic_dec(&priv->wmm.tx_pkts_queued);
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001237 }
1238}
1239
1240/*
1241 * This function dequeues a packet from the highest priority list
1242 * and transmits it.
1243 */
1244static int
1245mwifiex_dequeue_tx_packet(struct mwifiex_adapter *adapter)
1246{
1247 struct mwifiex_ra_list_tbl *ptr;
1248 struct mwifiex_private *priv = NULL;
1249 int ptr_index = 0;
1250 u8 ra[ETH_ALEN];
1251 int tid_del = 0, tid = 0;
1252 unsigned long flags;
1253
1254 ptr = mwifiex_wmm_get_highest_priolist_ptr(adapter, &priv, &ptr_index);
1255 if (!ptr)
1256 return -1;
1257
Amitkumar Karwar572e8f32011-04-13 17:27:08 -07001258 tid = mwifiex_get_tid(ptr);
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001259
1260 dev_dbg(adapter->dev, "data: tid=%d\n", tid);
1261
1262 spin_lock_irqsave(&priv->wmm.ra_list_spinlock, flags);
1263 if (!mwifiex_is_ralist_valid(priv, ptr, ptr_index)) {
1264 spin_unlock_irqrestore(&priv->wmm.ra_list_spinlock, flags);
1265 return -1;
1266 }
1267
1268 if (mwifiex_is_ptr_processed(priv, ptr)) {
1269 mwifiex_send_processed_packet(priv, ptr, ptr_index, flags);
1270 /* ra_list_spinlock has been freed in
1271 mwifiex_send_processed_packet() */
1272 return 0;
1273 }
1274
Yogesh Ashok Powarc65a30f2012-03-13 19:22:42 -07001275 if (!ptr->is_11n_enabled ||
1276 mwifiex_is_ba_stream_setup(priv, ptr, tid) ||
Amitkumar Karwar4c9f9fb2014-03-07 19:41:31 -08001277 priv->wps.session_enable) {
1278 if (ptr->is_11n_enabled &&
1279 mwifiex_is_ba_stream_setup(priv, ptr, tid) &&
1280 mwifiex_is_amsdu_in_ampdu_allowed(priv, ptr, tid) &&
1281 mwifiex_is_amsdu_allowed(priv, tid) &&
1282 mwifiex_is_11n_aggragation_possible(priv, ptr,
1283 adapter->tx_buf_size))
1284 mwifiex_11n_aggregate_pkt(priv, ptr, ptr_index, flags);
1285 /* ra_list_spinlock has been freed in
1286 * mwifiex_11n_aggregate_pkt()
1287 */
1288 else
1289 mwifiex_send_single_packet(priv, ptr, ptr_index, flags);
1290 /* ra_list_spinlock has been freed in
1291 * mwifiex_send_single_packet()
1292 */
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001293 } else {
Avinash Patileac43222014-02-07 16:27:28 -08001294 if (mwifiex_is_ampdu_allowed(priv, ptr, tid) &&
Avinash Patilf0cb84f2013-07-22 19:17:39 -07001295 ptr->ba_pkt_count > ptr->ba_packet_thr) {
Bing Zhao53d79382011-04-13 17:27:09 -07001296 if (mwifiex_space_avail_for_new_ba_stream(adapter)) {
Yogesh Ashok Powar3e822632012-03-12 19:35:08 -07001297 mwifiex_create_ba_tbl(priv, ptr->ra, tid,
1298 BA_SETUP_INPROGRESS);
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001299 mwifiex_send_addba(priv, tid, ptr->ra);
1300 } else if (mwifiex_find_stream_to_delete
Amitkumar Karwar572e8f32011-04-13 17:27:08 -07001301 (priv, tid, &tid_del, ra)) {
Yogesh Ashok Powar3e822632012-03-12 19:35:08 -07001302 mwifiex_create_ba_tbl(priv, ptr->ra, tid,
1303 BA_SETUP_INPROGRESS);
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001304 mwifiex_send_delba(priv, tid_del, ra, 1);
1305 }
1306 }
Amitkumar Karwar4c9f9fb2014-03-07 19:41:31 -08001307 if (mwifiex_is_amsdu_allowed(priv, tid) &&
Amitkumar Karward85c5fe2011-09-29 20:43:40 -07001308 mwifiex_is_11n_aggragation_possible(priv, ptr,
1309 adapter->tx_buf_size))
Amitkumar Karwarbd1c6142013-09-24 19:31:24 -07001310 mwifiex_11n_aggregate_pkt(priv, ptr, ptr_index, flags);
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001311 /* ra_list_spinlock has been freed in
1312 mwifiex_11n_aggregate_pkt() */
1313 else
1314 mwifiex_send_single_packet(priv, ptr, ptr_index, flags);
1315 /* ra_list_spinlock has been freed in
1316 mwifiex_send_single_packet() */
1317 }
1318 return 0;
1319}
1320
1321/*
1322 * This function transmits the highest priority packet awaiting in the
1323 * WMM Queues.
1324 */
1325void
1326mwifiex_wmm_process_tx(struct mwifiex_adapter *adapter)
1327{
1328 do {
1329 /* Check if busy */
1330 if (adapter->data_sent || adapter->tx_lock_flag)
1331 break;
1332
1333 if (mwifiex_dequeue_tx_packet(adapter))
1334 break;
Marc Yang93968142011-05-16 19:17:51 -07001335 } while (!mwifiex_wmm_lists_empty(adapter));
Bing Zhao5e6e3a92011-03-21 18:00:50 -07001336}