2 * Marvell Wireless LAN device driver: 802.11n
4 * Copyright (C) 2011, Marvell International Ltd.
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.
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.
29 * Fills HT capability information field, AMPDU Parameters field, HT extended
30 * capability field, and supported MCS set fields.
32 * HT capability information field, AMPDU Parameters field, supported MCS set
33 * fields are retrieved from cfg80211 stack
35 * RD responder bit to set to clear in the extended capability header.
38 mwifiex_fill_cap_info(struct mwifiex_private
*priv
, u8 radio_type
,
39 struct mwifiex_ie_types_htcap
*ht_cap
)
41 uint16_t ht_ext_cap
= le16_to_cpu(ht_cap
->ht_cap
.extended_ht_cap_info
);
42 struct ieee80211_supported_band
*sband
=
43 priv
->wdev
->wiphy
->bands
[radio_type
];
45 ht_cap
->ht_cap
.ampdu_params_info
=
46 (sband
->ht_cap
.ampdu_factor
&
47 IEEE80211_HT_AMPDU_PARM_FACTOR
) |
48 ((sband
->ht_cap
.ampdu_density
<<
49 IEEE80211_HT_AMPDU_PARM_DENSITY_SHIFT
) &
50 IEEE80211_HT_AMPDU_PARM_DENSITY
);
52 memcpy((u8
*) &ht_cap
->ht_cap
.mcs
, &sband
->ht_cap
.mcs
,
53 sizeof(sband
->ht_cap
.mcs
));
55 if (priv
->bss_mode
== NL80211_IFTYPE_STATION
||
56 sband
->ht_cap
.cap
& IEEE80211_HT_CAP_SUP_WIDTH_20_40
)
57 /* Set MCS32 for infra mode or ad-hoc mode with 40MHz support */
58 SETHT_MCS32(ht_cap
->ht_cap
.mcs
.rx_mask
);
60 /* Clear RD responder bit */
61 ht_ext_cap
&= ~IEEE80211_HT_EXT_CAP_RD_RESPONDER
;
63 ht_cap
->ht_cap
.cap_info
= cpu_to_le16(sband
->ht_cap
.cap
);
64 ht_cap
->ht_cap
.extended_ht_cap_info
= cpu_to_le16(ht_ext_cap
);
68 * This function returns the pointer to an entry in BA Stream
69 * table which matches the requested BA status.
71 static struct mwifiex_tx_ba_stream_tbl
*
72 mwifiex_get_ba_status(struct mwifiex_private
*priv
,
73 enum mwifiex_ba_status ba_status
)
75 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tsr_tbl
;
78 spin_lock_irqsave(&priv
->tx_ba_stream_tbl_lock
, flags
);
79 list_for_each_entry(tx_ba_tsr_tbl
, &priv
->tx_ba_stream_tbl_ptr
, list
) {
80 if (tx_ba_tsr_tbl
->ba_status
== ba_status
) {
81 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
,
86 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
, flags
);
91 * This function handles the command response of delete a block
94 * The function checks the response success status and takes action
95 * accordingly (send an add BA request in case of success, or recreate
96 * the deleted stream in case of failure, if the add BA was also
99 int mwifiex_ret_11n_delba(struct mwifiex_private
*priv
,
100 struct host_cmd_ds_command
*resp
)
103 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tbl
;
104 struct host_cmd_ds_11n_delba
*del_ba
= &resp
->params
.del_ba
;
105 uint16_t del_ba_param_set
= le16_to_cpu(del_ba
->del_ba_param_set
);
107 tid
= del_ba_param_set
>> DELBA_TID_POS
;
108 if (del_ba
->del_result
== BA_RESULT_SUCCESS
) {
109 mwifiex_del_ba_tbl(priv
, tid
, del_ba
->peer_mac_addr
,
111 INITIATOR_BIT(del_ba_param_set
));
113 tx_ba_tbl
= mwifiex_get_ba_status(priv
, BA_SETUP_INPROGRESS
);
115 mwifiex_send_addba(priv
, tx_ba_tbl
->tid
,
118 * In case of failure, recreate the deleted stream in case
119 * we initiated the ADDBA
121 if (!INITIATOR_BIT(del_ba_param_set
))
124 mwifiex_create_ba_tbl(priv
, del_ba
->peer_mac_addr
, tid
,
125 BA_SETUP_INPROGRESS
);
127 tx_ba_tbl
= mwifiex_get_ba_status(priv
, BA_SETUP_INPROGRESS
);
130 mwifiex_del_ba_tbl(priv
, tx_ba_tbl
->tid
, tx_ba_tbl
->ra
,
131 TYPE_DELBA_SENT
, true);
138 * This function handles the command response of add a block
141 * Handling includes changing the header fields to CPU formats, checking
142 * the response success status and taking actions accordingly (delete the
143 * BA stream table in case of failure).
145 int mwifiex_ret_11n_addba_req(struct mwifiex_private
*priv
,
146 struct host_cmd_ds_command
*resp
)
149 struct host_cmd_ds_11n_addba_rsp
*add_ba_rsp
= &resp
->params
.add_ba_rsp
;
150 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tbl
;
152 add_ba_rsp
->ssn
= cpu_to_le16((le16_to_cpu(add_ba_rsp
->ssn
))
155 tid
= (le16_to_cpu(add_ba_rsp
->block_ack_param_set
)
156 & IEEE80211_ADDBA_PARAM_TID_MASK
)
157 >> BLOCKACKPARAM_TID_POS
;
158 if (le16_to_cpu(add_ba_rsp
->status_code
) == BA_RESULT_SUCCESS
) {
159 tx_ba_tbl
= mwifiex_get_ba_tbl(priv
, tid
,
160 add_ba_rsp
->peer_mac_addr
);
162 dev_dbg(priv
->adapter
->dev
, "info: BA stream complete\n");
163 tx_ba_tbl
->ba_status
= BA_SETUP_COMPLETE
;
165 dev_err(priv
->adapter
->dev
, "BA stream not created\n");
168 mwifiex_del_ba_tbl(priv
, tid
, add_ba_rsp
->peer_mac_addr
,
169 TYPE_DELBA_SENT
, true);
170 if (add_ba_rsp
->add_rsp_result
!= BA_RESULT_TIMEOUT
)
171 priv
->aggr_prio_tbl
[tid
].ampdu_ap
=
172 BA_STREAM_NOT_ALLOWED
;
179 * This function handles the command response of 11n configuration request.
181 * Handling includes changing the header fields into CPU format.
183 int mwifiex_ret_11n_cfg(struct host_cmd_ds_command
*resp
,
184 struct mwifiex_ds_11n_tx_cfg
*tx_cfg
)
186 struct host_cmd_ds_11n_cfg
*htcfg
= &resp
->params
.htcfg
;
189 tx_cfg
->tx_htcap
= le16_to_cpu(htcfg
->ht_tx_cap
);
190 tx_cfg
->tx_htinfo
= le16_to_cpu(htcfg
->ht_tx_info
);
196 * This function prepares command of reconfigure Tx buffer.
198 * Preparation includes -
199 * - Setting command ID, action and proper size
200 * - Setting Tx buffer size (for SET only)
201 * - Ensuring correct endian-ness
203 int mwifiex_cmd_recfg_tx_buf(struct mwifiex_private
*priv
,
204 struct host_cmd_ds_command
*cmd
, int cmd_action
,
207 struct host_cmd_ds_txbuf_cfg
*tx_buf
= &cmd
->params
.tx_buf
;
208 u16 action
= (u16
) cmd_action
;
210 cmd
->command
= cpu_to_le16(HostCmd_CMD_RECONFIGURE_TX_BUFF
);
212 cpu_to_le16(sizeof(struct host_cmd_ds_txbuf_cfg
) + S_DS_GEN
);
213 tx_buf
->action
= cpu_to_le16(action
);
215 case HostCmd_ACT_GEN_SET
:
216 dev_dbg(priv
->adapter
->dev
, "cmd: set tx_buf=%d\n", *buf_size
);
217 tx_buf
->buff_size
= cpu_to_le16(*buf_size
);
219 case HostCmd_ACT_GEN_GET
:
221 tx_buf
->buff_size
= 0;
228 * This function prepares command of AMSDU aggregation control.
230 * Preparation includes -
231 * - Setting command ID, action and proper size
232 * - Setting AMSDU control parameters (for SET only)
233 * - Ensuring correct endian-ness
235 int mwifiex_cmd_amsdu_aggr_ctrl(struct host_cmd_ds_command
*cmd
,
237 struct mwifiex_ds_11n_amsdu_aggr_ctrl
*aa_ctrl
)
239 struct host_cmd_ds_amsdu_aggr_ctrl
*amsdu_ctrl
=
240 &cmd
->params
.amsdu_aggr_ctrl
;
241 u16 action
= (u16
) cmd_action
;
243 cmd
->command
= cpu_to_le16(HostCmd_CMD_AMSDU_AGGR_CTRL
);
244 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_amsdu_aggr_ctrl
)
246 amsdu_ctrl
->action
= cpu_to_le16(action
);
248 case HostCmd_ACT_GEN_SET
:
249 amsdu_ctrl
->enable
= cpu_to_le16(aa_ctrl
->enable
);
250 amsdu_ctrl
->curr_buf_size
= 0;
252 case HostCmd_ACT_GEN_GET
:
254 amsdu_ctrl
->curr_buf_size
= 0;
261 * This function handles the command response of AMSDU aggregation
264 * Handling includes changing the header fields into CPU format.
266 int mwifiex_ret_amsdu_aggr_ctrl(struct host_cmd_ds_command
*resp
,
267 struct mwifiex_ds_11n_amsdu_aggr_ctrl
270 struct host_cmd_ds_amsdu_aggr_ctrl
*amsdu_ctrl
=
271 &resp
->params
.amsdu_aggr_ctrl
;
273 if (amsdu_aggr_ctrl
) {
274 amsdu_aggr_ctrl
->enable
= le16_to_cpu(amsdu_ctrl
->enable
);
275 amsdu_aggr_ctrl
->curr_buf_size
=
276 le16_to_cpu(amsdu_ctrl
->curr_buf_size
);
282 * This function prepares 11n configuration command.
284 * Preparation includes -
285 * - Setting command ID, action and proper size
286 * - Setting HT Tx capability and HT Tx information fields
287 * - Ensuring correct endian-ness
289 int mwifiex_cmd_11n_cfg(struct host_cmd_ds_command
*cmd
, u16 cmd_action
,
290 struct mwifiex_ds_11n_tx_cfg
*txcfg
)
292 struct host_cmd_ds_11n_cfg
*htcfg
= &cmd
->params
.htcfg
;
294 cmd
->command
= cpu_to_le16(HostCmd_CMD_11N_CFG
);
295 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_11n_cfg
) + S_DS_GEN
);
296 htcfg
->action
= cpu_to_le16(cmd_action
);
297 htcfg
->ht_tx_cap
= cpu_to_le16(txcfg
->tx_htcap
);
298 htcfg
->ht_tx_info
= cpu_to_le16(txcfg
->tx_htinfo
);
303 * This function appends an 11n TLV to a buffer.
305 * Buffer allocation is responsibility of the calling
306 * function. No size validation is made here.
308 * The function fills up the following sections, if applicable -
310 * - HT information IE (with channel list)
311 * - 20/40 BSS Coexistence IE
312 * - HT Extended Capabilities IE
315 mwifiex_cmd_append_11n_tlv(struct mwifiex_private
*priv
,
316 struct mwifiex_bssdescriptor
*bss_desc
,
319 struct mwifiex_ie_types_htcap
*ht_cap
;
320 struct mwifiex_ie_types_htinfo
*ht_info
;
321 struct mwifiex_ie_types_chan_list_param_set
*chan_list
;
322 struct mwifiex_ie_types_2040bssco
*bss_co_2040
;
323 struct mwifiex_ie_types_extcap
*ext_cap
;
325 struct ieee80211_supported_band
*sband
;
328 if (!buffer
|| !*buffer
)
331 radio_type
= mwifiex_band_to_radio_type((u8
) bss_desc
->bss_band
);
332 sband
= priv
->wdev
->wiphy
->bands
[radio_type
];
334 if (bss_desc
->bcn_ht_cap
) {
335 ht_cap
= (struct mwifiex_ie_types_htcap
*) *buffer
;
336 memset(ht_cap
, 0, sizeof(struct mwifiex_ie_types_htcap
));
337 ht_cap
->header
.type
= cpu_to_le16(WLAN_EID_HT_CAPABILITY
);
339 cpu_to_le16(sizeof(struct ieee80211_ht_cap
));
340 memcpy((u8
*) ht_cap
+ sizeof(struct mwifiex_ie_types_header
),
341 (u8
*) bss_desc
->bcn_ht_cap
+
342 sizeof(struct ieee_types_header
),
343 le16_to_cpu(ht_cap
->header
.len
));
345 mwifiex_fill_cap_info(priv
, radio_type
, ht_cap
);
347 *buffer
+= sizeof(struct mwifiex_ie_types_htcap
);
348 ret_len
+= sizeof(struct mwifiex_ie_types_htcap
);
351 if (bss_desc
->bcn_ht_oper
) {
352 if (priv
->bss_mode
== NL80211_IFTYPE_ADHOC
) {
353 ht_info
= (struct mwifiex_ie_types_htinfo
*) *buffer
;
355 sizeof(struct mwifiex_ie_types_htinfo
));
356 ht_info
->header
.type
=
357 cpu_to_le16(WLAN_EID_HT_OPERATION
);
358 ht_info
->header
.len
=
360 sizeof(struct ieee80211_ht_operation
));
362 memcpy((u8
*) ht_info
+
363 sizeof(struct mwifiex_ie_types_header
),
364 (u8
*) bss_desc
->bcn_ht_oper
+
365 sizeof(struct ieee_types_header
),
366 le16_to_cpu(ht_info
->header
.len
));
368 if (!(sband
->ht_cap
.cap
&
369 IEEE80211_HT_CAP_SUP_WIDTH_20_40
))
370 ht_info
->ht_oper
.ht_param
&=
371 ~(IEEE80211_HT_PARAM_CHAN_WIDTH_ANY
|
372 IEEE80211_HT_PARAM_CHA_SEC_OFFSET
);
374 *buffer
+= sizeof(struct mwifiex_ie_types_htinfo
);
375 ret_len
+= sizeof(struct mwifiex_ie_types_htinfo
);
379 (struct mwifiex_ie_types_chan_list_param_set
*) *buffer
;
381 sizeof(struct mwifiex_ie_types_chan_list_param_set
));
382 chan_list
->header
.type
= cpu_to_le16(TLV_TYPE_CHANLIST
);
383 chan_list
->header
.len
= cpu_to_le16(
384 sizeof(struct mwifiex_ie_types_chan_list_param_set
) -
385 sizeof(struct mwifiex_ie_types_header
));
386 chan_list
->chan_scan_param
[0].chan_number
=
387 bss_desc
->bcn_ht_oper
->primary_chan
;
388 chan_list
->chan_scan_param
[0].radio_type
=
389 mwifiex_band_to_radio_type((u8
) bss_desc
->bss_band
);
391 if (sband
->ht_cap
.cap
& IEEE80211_HT_CAP_SUP_WIDTH_20_40
&&
392 bss_desc
->bcn_ht_oper
->ht_param
&
393 IEEE80211_HT_PARAM_CHAN_WIDTH_ANY
)
394 SET_SECONDARYCHAN(chan_list
->chan_scan_param
[0].
396 (bss_desc
->bcn_ht_oper
->ht_param
&
397 IEEE80211_HT_PARAM_CHA_SEC_OFFSET
));
399 *buffer
+= sizeof(struct mwifiex_ie_types_chan_list_param_set
);
400 ret_len
+= sizeof(struct mwifiex_ie_types_chan_list_param_set
);
403 if (bss_desc
->bcn_bss_co_2040
) {
404 bss_co_2040
= (struct mwifiex_ie_types_2040bssco
*) *buffer
;
405 memset(bss_co_2040
, 0,
406 sizeof(struct mwifiex_ie_types_2040bssco
));
407 bss_co_2040
->header
.type
= cpu_to_le16(WLAN_EID_BSS_COEX_2040
);
408 bss_co_2040
->header
.len
=
409 cpu_to_le16(sizeof(bss_co_2040
->bss_co_2040
));
411 memcpy((u8
*) bss_co_2040
+
412 sizeof(struct mwifiex_ie_types_header
),
413 bss_desc
->bcn_bss_co_2040
+
414 sizeof(struct ieee_types_header
),
415 le16_to_cpu(bss_co_2040
->header
.len
));
417 *buffer
+= sizeof(struct mwifiex_ie_types_2040bssco
);
418 ret_len
+= sizeof(struct mwifiex_ie_types_2040bssco
);
421 if (bss_desc
->bcn_ext_cap
) {
422 ext_cap
= (struct mwifiex_ie_types_extcap
*) *buffer
;
423 memset(ext_cap
, 0, sizeof(struct mwifiex_ie_types_extcap
));
424 ext_cap
->header
.type
= cpu_to_le16(WLAN_EID_EXT_CAPABILITY
);
425 ext_cap
->header
.len
= cpu_to_le16(sizeof(ext_cap
->ext_cap
));
427 memcpy((u8
*)ext_cap
+ sizeof(struct mwifiex_ie_types_header
),
428 bss_desc
->bcn_ext_cap
+ sizeof(struct ieee_types_header
),
429 le16_to_cpu(ext_cap
->header
.len
));
431 *buffer
+= sizeof(struct mwifiex_ie_types_extcap
);
432 ret_len
+= sizeof(struct mwifiex_ie_types_extcap
);
439 * This function reconfigures the Tx buffer size in firmware.
441 * This function prepares a firmware command and issues it, if
442 * the current Tx buffer size is different from the one requested.
443 * Maximum configurable Tx buffer size is limited by the HT capability
447 mwifiex_cfg_tx_buf(struct mwifiex_private
*priv
,
448 struct mwifiex_bssdescriptor
*bss_desc
)
450 u16 max_amsdu
= MWIFIEX_TX_DATA_BUF_SIZE_2K
;
451 u16 tx_buf
, curr_tx_buf_size
= 0;
453 if (bss_desc
->bcn_ht_cap
) {
454 if (le16_to_cpu(bss_desc
->bcn_ht_cap
->cap_info
) &
455 IEEE80211_HT_CAP_MAX_AMSDU
)
456 max_amsdu
= MWIFIEX_TX_DATA_BUF_SIZE_8K
;
458 max_amsdu
= MWIFIEX_TX_DATA_BUF_SIZE_4K
;
461 tx_buf
= min(priv
->adapter
->max_tx_buf_size
, max_amsdu
);
463 dev_dbg(priv
->adapter
->dev
, "info: max_amsdu=%d, max_tx_buf=%d\n",
464 max_amsdu
, priv
->adapter
->max_tx_buf_size
);
466 if (priv
->adapter
->curr_tx_buf_size
<= MWIFIEX_TX_DATA_BUF_SIZE_2K
)
467 curr_tx_buf_size
= MWIFIEX_TX_DATA_BUF_SIZE_2K
;
468 else if (priv
->adapter
->curr_tx_buf_size
<= MWIFIEX_TX_DATA_BUF_SIZE_4K
)
469 curr_tx_buf_size
= MWIFIEX_TX_DATA_BUF_SIZE_4K
;
470 else if (priv
->adapter
->curr_tx_buf_size
<= MWIFIEX_TX_DATA_BUF_SIZE_8K
)
471 curr_tx_buf_size
= MWIFIEX_TX_DATA_BUF_SIZE_8K
;
472 if (curr_tx_buf_size
!= tx_buf
)
473 mwifiex_send_cmd_async(priv
, HostCmd_CMD_RECONFIGURE_TX_BUFF
,
474 HostCmd_ACT_GEN_SET
, 0, &tx_buf
);
478 * This function checks if the given pointer is valid entry of
479 * Tx BA Stream table.
481 static int mwifiex_is_tx_ba_stream_ptr_valid(struct mwifiex_private
*priv
,
482 struct mwifiex_tx_ba_stream_tbl
*tx_tbl_ptr
)
484 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tsr_tbl
;
486 list_for_each_entry(tx_ba_tsr_tbl
, &priv
->tx_ba_stream_tbl_ptr
, list
) {
487 if (tx_ba_tsr_tbl
== tx_tbl_ptr
)
495 * This function deletes the given entry in Tx BA Stream table.
497 * The function also performs a validity check on the supplied
498 * pointer before trying to delete.
500 void mwifiex_11n_delete_tx_ba_stream_tbl_entry(struct mwifiex_private
*priv
,
501 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tsr_tbl
)
503 if (!tx_ba_tsr_tbl
&&
504 mwifiex_is_tx_ba_stream_ptr_valid(priv
, tx_ba_tsr_tbl
))
507 dev_dbg(priv
->adapter
->dev
, "info: tx_ba_tsr_tbl %p\n", tx_ba_tsr_tbl
);
509 list_del(&tx_ba_tsr_tbl
->list
);
511 kfree(tx_ba_tsr_tbl
);
515 * This function deletes all the entries in Tx BA Stream table.
517 void mwifiex_11n_delete_all_tx_ba_stream_tbl(struct mwifiex_private
*priv
)
520 struct mwifiex_tx_ba_stream_tbl
*del_tbl_ptr
, *tmp_node
;
523 spin_lock_irqsave(&priv
->tx_ba_stream_tbl_lock
, flags
);
524 list_for_each_entry_safe(del_tbl_ptr
, tmp_node
,
525 &priv
->tx_ba_stream_tbl_ptr
, list
)
526 mwifiex_11n_delete_tx_ba_stream_tbl_entry(priv
, del_tbl_ptr
);
527 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
, flags
);
529 INIT_LIST_HEAD(&priv
->tx_ba_stream_tbl_ptr
);
531 for (i
= 0; i
< MAX_NUM_TID
; ++i
)
532 priv
->aggr_prio_tbl
[i
].ampdu_ap
=
533 priv
->aggr_prio_tbl
[i
].ampdu_user
;
537 * This function returns the pointer to an entry in BA Stream
538 * table which matches the given RA/TID pair.
540 struct mwifiex_tx_ba_stream_tbl
*
541 mwifiex_get_ba_tbl(struct mwifiex_private
*priv
, int tid
, u8
*ra
)
543 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tsr_tbl
;
546 spin_lock_irqsave(&priv
->tx_ba_stream_tbl_lock
, flags
);
547 list_for_each_entry(tx_ba_tsr_tbl
, &priv
->tx_ba_stream_tbl_ptr
, list
) {
548 if (!memcmp(tx_ba_tsr_tbl
->ra
, ra
, ETH_ALEN
) &&
549 tx_ba_tsr_tbl
->tid
== tid
) {
550 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
,
552 return tx_ba_tsr_tbl
;
555 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
, flags
);
560 * This function creates an entry in Tx BA stream table for the
563 void mwifiex_create_ba_tbl(struct mwifiex_private
*priv
, u8
*ra
, int tid
,
564 enum mwifiex_ba_status ba_status
)
566 struct mwifiex_tx_ba_stream_tbl
*new_node
;
569 if (!mwifiex_get_ba_tbl(priv
, tid
, ra
)) {
570 new_node
= kzalloc(sizeof(struct mwifiex_tx_ba_stream_tbl
),
573 dev_err(priv
->adapter
->dev
,
574 "%s: failed to alloc new_node\n", __func__
);
578 INIT_LIST_HEAD(&new_node
->list
);
581 new_node
->ba_status
= ba_status
;
582 memcpy(new_node
->ra
, ra
, ETH_ALEN
);
584 spin_lock_irqsave(&priv
->tx_ba_stream_tbl_lock
, flags
);
585 list_add_tail(&new_node
->list
, &priv
->tx_ba_stream_tbl_ptr
);
586 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
, flags
);
591 * This function sends an add BA request to the given TID/RA pair.
593 int mwifiex_send_addba(struct mwifiex_private
*priv
, int tid
, u8
*peer_mac
)
595 struct host_cmd_ds_11n_addba_req add_ba_req
;
596 static u8 dialog_tok
;
599 dev_dbg(priv
->adapter
->dev
, "cmd: %s: tid %d\n", __func__
, tid
);
601 add_ba_req
.block_ack_param_set
= cpu_to_le16(
602 (u16
) ((tid
<< BLOCKACKPARAM_TID_POS
) |
604 tx_win_size
<< BLOCKACKPARAM_WINSIZE_POS
) |
605 IMMEDIATE_BLOCK_ACK
));
606 add_ba_req
.block_ack_tmo
= cpu_to_le16((u16
)priv
->add_ba_param
.timeout
);
613 add_ba_req
.dialog_token
= dialog_tok
;
614 memcpy(&add_ba_req
.peer_mac_addr
, peer_mac
, ETH_ALEN
);
616 /* We don't wait for the response of this command */
617 ret
= mwifiex_send_cmd_async(priv
, HostCmd_CMD_11N_ADDBA_REQ
,
624 * This function sends a delete BA request to the given TID/RA pair.
626 int mwifiex_send_delba(struct mwifiex_private
*priv
, int tid
, u8
*peer_mac
,
629 struct host_cmd_ds_11n_delba delba
;
631 uint16_t del_ba_param_set
;
633 memset(&delba
, 0, sizeof(delba
));
634 delba
.del_ba_param_set
= cpu_to_le16(tid
<< DELBA_TID_POS
);
636 del_ba_param_set
= le16_to_cpu(delba
.del_ba_param_set
);
638 del_ba_param_set
|= IEEE80211_DELBA_PARAM_INITIATOR_MASK
;
640 del_ba_param_set
&= ~IEEE80211_DELBA_PARAM_INITIATOR_MASK
;
642 memcpy(&delba
.peer_mac_addr
, peer_mac
, ETH_ALEN
);
644 /* We don't wait for the response of this command */
645 ret
= mwifiex_send_cmd_async(priv
, HostCmd_CMD_11N_DELBA
,
646 HostCmd_ACT_GEN_SET
, 0, &delba
);
652 * This function handles the command response of a delete BA request.
654 void mwifiex_11n_delete_ba_stream(struct mwifiex_private
*priv
, u8
*del_ba
)
656 struct host_cmd_ds_11n_delba
*cmd_del_ba
=
657 (struct host_cmd_ds_11n_delba
*) del_ba
;
658 uint16_t del_ba_param_set
= le16_to_cpu(cmd_del_ba
->del_ba_param_set
);
661 tid
= del_ba_param_set
>> DELBA_TID_POS
;
663 mwifiex_del_ba_tbl(priv
, tid
, cmd_del_ba
->peer_mac_addr
,
664 TYPE_DELBA_RECEIVE
, INITIATOR_BIT(del_ba_param_set
));
668 * This function retrieves the Rx reordering table.
670 int mwifiex_get_rx_reorder_tbl(struct mwifiex_private
*priv
,
671 struct mwifiex_ds_rx_reorder_tbl
*buf
)
674 struct mwifiex_ds_rx_reorder_tbl
*rx_reo_tbl
= buf
;
675 struct mwifiex_rx_reorder_tbl
*rx_reorder_tbl_ptr
;
679 spin_lock_irqsave(&priv
->rx_reorder_tbl_lock
, flags
);
680 list_for_each_entry(rx_reorder_tbl_ptr
, &priv
->rx_reorder_tbl_ptr
,
682 rx_reo_tbl
->tid
= (u16
) rx_reorder_tbl_ptr
->tid
;
683 memcpy(rx_reo_tbl
->ta
, rx_reorder_tbl_ptr
->ta
, ETH_ALEN
);
684 rx_reo_tbl
->start_win
= rx_reorder_tbl_ptr
->start_win
;
685 rx_reo_tbl
->win_size
= rx_reorder_tbl_ptr
->win_size
;
686 for (i
= 0; i
< rx_reorder_tbl_ptr
->win_size
; ++i
) {
687 if (rx_reorder_tbl_ptr
->rx_reorder_ptr
[i
])
688 rx_reo_tbl
->buffer
[i
] = true;
690 rx_reo_tbl
->buffer
[i
] = false;
695 if (count
>= MWIFIEX_MAX_RX_BASTREAM_SUPPORTED
)
698 spin_unlock_irqrestore(&priv
->rx_reorder_tbl_lock
, flags
);
704 * This function retrieves the Tx BA stream table.
706 int mwifiex_get_tx_ba_stream_tbl(struct mwifiex_private
*priv
,
707 struct mwifiex_ds_tx_ba_stream_tbl
*buf
)
709 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tsr_tbl
;
710 struct mwifiex_ds_tx_ba_stream_tbl
*rx_reo_tbl
= buf
;
714 spin_lock_irqsave(&priv
->tx_ba_stream_tbl_lock
, flags
);
715 list_for_each_entry(tx_ba_tsr_tbl
, &priv
->tx_ba_stream_tbl_ptr
, list
) {
716 rx_reo_tbl
->tid
= (u16
) tx_ba_tsr_tbl
->tid
;
717 dev_dbg(priv
->adapter
->dev
, "data: %s tid=%d\n",
718 __func__
, rx_reo_tbl
->tid
);
719 memcpy(rx_reo_tbl
->ra
, tx_ba_tsr_tbl
->ra
, ETH_ALEN
);
722 if (count
>= MWIFIEX_MAX_TX_BASTREAM_SUPPORTED
)
725 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
, flags
);