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
=
105 (struct host_cmd_ds_11n_delba
*) &resp
->params
.del_ba
;
106 uint16_t del_ba_param_set
= le16_to_cpu(del_ba
->del_ba_param_set
);
108 tid
= del_ba_param_set
>> DELBA_TID_POS
;
109 if (del_ba
->del_result
== BA_RESULT_SUCCESS
) {
110 mwifiex_del_ba_tbl(priv
, tid
, del_ba
->peer_mac_addr
,
112 INITIATOR_BIT(del_ba_param_set
));
114 tx_ba_tbl
= mwifiex_get_ba_status(priv
, BA_SETUP_INPROGRESS
);
116 mwifiex_send_addba(priv
, tx_ba_tbl
->tid
,
119 * In case of failure, recreate the deleted stream in case
120 * we initiated the ADDBA
122 if (!INITIATOR_BIT(del_ba_param_set
))
125 mwifiex_create_ba_tbl(priv
, del_ba
->peer_mac_addr
, tid
,
126 BA_SETUP_INPROGRESS
);
128 tx_ba_tbl
= mwifiex_get_ba_status(priv
, BA_SETUP_INPROGRESS
);
131 mwifiex_del_ba_tbl(priv
, tx_ba_tbl
->tid
, tx_ba_tbl
->ra
,
132 TYPE_DELBA_SENT
, true);
139 * This function handles the command response of add a block
142 * Handling includes changing the header fields to CPU formats, checking
143 * the response success status and taking actions accordingly (delete the
144 * BA stream table in case of failure).
146 int mwifiex_ret_11n_addba_req(struct mwifiex_private
*priv
,
147 struct host_cmd_ds_command
*resp
)
150 struct host_cmd_ds_11n_addba_rsp
*add_ba_rsp
=
151 (struct host_cmd_ds_11n_addba_rsp
*) &resp
->params
.add_ba_rsp
;
152 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tbl
;
154 add_ba_rsp
->ssn
= cpu_to_le16((le16_to_cpu(add_ba_rsp
->ssn
))
157 tid
= (le16_to_cpu(add_ba_rsp
->block_ack_param_set
)
158 & IEEE80211_ADDBA_PARAM_TID_MASK
)
159 >> BLOCKACKPARAM_TID_POS
;
160 if (le16_to_cpu(add_ba_rsp
->status_code
) == BA_RESULT_SUCCESS
) {
161 tx_ba_tbl
= mwifiex_get_ba_tbl(priv
, tid
,
162 add_ba_rsp
->peer_mac_addr
);
164 dev_dbg(priv
->adapter
->dev
, "info: BA stream complete\n");
165 tx_ba_tbl
->ba_status
= BA_SETUP_COMPLETE
;
167 dev_err(priv
->adapter
->dev
, "BA stream not created\n");
170 mwifiex_del_ba_tbl(priv
, tid
, add_ba_rsp
->peer_mac_addr
,
171 TYPE_DELBA_SENT
, true);
172 if (add_ba_rsp
->add_rsp_result
!= BA_RESULT_TIMEOUT
)
173 priv
->aggr_prio_tbl
[tid
].ampdu_ap
=
174 BA_STREAM_NOT_ALLOWED
;
181 * This function handles the command response of 11n configuration request.
183 * Handling includes changing the header fields into CPU format.
185 int mwifiex_ret_11n_cfg(struct host_cmd_ds_command
*resp
,
186 struct mwifiex_ds_11n_tx_cfg
*tx_cfg
)
188 struct host_cmd_ds_11n_cfg
*htcfg
= &resp
->params
.htcfg
;
191 tx_cfg
->tx_htcap
= le16_to_cpu(htcfg
->ht_tx_cap
);
192 tx_cfg
->tx_htinfo
= le16_to_cpu(htcfg
->ht_tx_info
);
198 * This function prepares command of reconfigure Tx buffer.
200 * Preparation includes -
201 * - Setting command ID, action and proper size
202 * - Setting Tx buffer size (for SET only)
203 * - Ensuring correct endian-ness
205 int mwifiex_cmd_recfg_tx_buf(struct mwifiex_private
*priv
,
206 struct host_cmd_ds_command
*cmd
, int cmd_action
,
209 struct host_cmd_ds_txbuf_cfg
*tx_buf
= &cmd
->params
.tx_buf
;
210 u16 action
= (u16
) cmd_action
;
212 cmd
->command
= cpu_to_le16(HostCmd_CMD_RECONFIGURE_TX_BUFF
);
214 cpu_to_le16(sizeof(struct host_cmd_ds_txbuf_cfg
) + S_DS_GEN
);
215 tx_buf
->action
= cpu_to_le16(action
);
217 case HostCmd_ACT_GEN_SET
:
218 dev_dbg(priv
->adapter
->dev
, "cmd: set tx_buf=%d\n", *buf_size
);
219 tx_buf
->buff_size
= cpu_to_le16(*buf_size
);
221 case HostCmd_ACT_GEN_GET
:
223 tx_buf
->buff_size
= 0;
230 * This function prepares command of AMSDU aggregation control.
232 * Preparation includes -
233 * - Setting command ID, action and proper size
234 * - Setting AMSDU control parameters (for SET only)
235 * - Ensuring correct endian-ness
237 int mwifiex_cmd_amsdu_aggr_ctrl(struct host_cmd_ds_command
*cmd
,
239 struct mwifiex_ds_11n_amsdu_aggr_ctrl
*aa_ctrl
)
241 struct host_cmd_ds_amsdu_aggr_ctrl
*amsdu_ctrl
=
242 &cmd
->params
.amsdu_aggr_ctrl
;
243 u16 action
= (u16
) cmd_action
;
245 cmd
->command
= cpu_to_le16(HostCmd_CMD_AMSDU_AGGR_CTRL
);
246 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_amsdu_aggr_ctrl
)
248 amsdu_ctrl
->action
= cpu_to_le16(action
);
250 case HostCmd_ACT_GEN_SET
:
251 amsdu_ctrl
->enable
= cpu_to_le16(aa_ctrl
->enable
);
252 amsdu_ctrl
->curr_buf_size
= 0;
254 case HostCmd_ACT_GEN_GET
:
256 amsdu_ctrl
->curr_buf_size
= 0;
263 * This function handles the command response of AMSDU aggregation
266 * Handling includes changing the header fields into CPU format.
268 int mwifiex_ret_amsdu_aggr_ctrl(struct host_cmd_ds_command
*resp
,
269 struct mwifiex_ds_11n_amsdu_aggr_ctrl
272 struct host_cmd_ds_amsdu_aggr_ctrl
*amsdu_ctrl
=
273 &resp
->params
.amsdu_aggr_ctrl
;
275 if (amsdu_aggr_ctrl
) {
276 amsdu_aggr_ctrl
->enable
= le16_to_cpu(amsdu_ctrl
->enable
);
277 amsdu_aggr_ctrl
->curr_buf_size
=
278 le16_to_cpu(amsdu_ctrl
->curr_buf_size
);
284 * This function prepares 11n configuration command.
286 * Preparation includes -
287 * - Setting command ID, action and proper size
288 * - Setting HT Tx capability and HT Tx information fields
289 * - Ensuring correct endian-ness
291 int mwifiex_cmd_11n_cfg(struct host_cmd_ds_command
*cmd
, u16 cmd_action
,
292 struct mwifiex_ds_11n_tx_cfg
*txcfg
)
294 struct host_cmd_ds_11n_cfg
*htcfg
= &cmd
->params
.htcfg
;
296 cmd
->command
= cpu_to_le16(HostCmd_CMD_11N_CFG
);
297 cmd
->size
= cpu_to_le16(sizeof(struct host_cmd_ds_11n_cfg
) + S_DS_GEN
);
298 htcfg
->action
= cpu_to_le16(cmd_action
);
299 htcfg
->ht_tx_cap
= cpu_to_le16(txcfg
->tx_htcap
);
300 htcfg
->ht_tx_info
= cpu_to_le16(txcfg
->tx_htinfo
);
305 * This function appends an 11n TLV to a buffer.
307 * Buffer allocation is responsibility of the calling
308 * function. No size validation is made here.
310 * The function fills up the following sections, if applicable -
312 * - HT information IE (with channel list)
313 * - 20/40 BSS Coexistence IE
314 * - HT Extended Capabilities IE
317 mwifiex_cmd_append_11n_tlv(struct mwifiex_private
*priv
,
318 struct mwifiex_bssdescriptor
*bss_desc
,
321 struct mwifiex_ie_types_htcap
*ht_cap
;
322 struct mwifiex_ie_types_htinfo
*ht_info
;
323 struct mwifiex_ie_types_chan_list_param_set
*chan_list
;
324 struct mwifiex_ie_types_2040bssco
*bss_co_2040
;
325 struct mwifiex_ie_types_extcap
*ext_cap
;
327 struct ieee80211_supported_band
*sband
;
330 if (!buffer
|| !*buffer
)
333 radio_type
= mwifiex_band_to_radio_type((u8
) bss_desc
->bss_band
);
334 sband
= priv
->wdev
->wiphy
->bands
[radio_type
];
336 if (bss_desc
->bcn_ht_cap
) {
337 ht_cap
= (struct mwifiex_ie_types_htcap
*) *buffer
;
338 memset(ht_cap
, 0, sizeof(struct mwifiex_ie_types_htcap
));
339 ht_cap
->header
.type
= cpu_to_le16(WLAN_EID_HT_CAPABILITY
);
341 cpu_to_le16(sizeof(struct ieee80211_ht_cap
));
342 memcpy((u8
*) ht_cap
+ sizeof(struct mwifiex_ie_types_header
),
343 (u8
*) bss_desc
->bcn_ht_cap
+
344 sizeof(struct ieee_types_header
),
345 le16_to_cpu(ht_cap
->header
.len
));
347 mwifiex_fill_cap_info(priv
, radio_type
, ht_cap
);
349 *buffer
+= sizeof(struct mwifiex_ie_types_htcap
);
350 ret_len
+= sizeof(struct mwifiex_ie_types_htcap
);
353 if (bss_desc
->bcn_ht_info
) {
354 if (priv
->bss_mode
== NL80211_IFTYPE_ADHOC
) {
355 ht_info
= (struct mwifiex_ie_types_htinfo
*) *buffer
;
357 sizeof(struct mwifiex_ie_types_htinfo
));
358 ht_info
->header
.type
=
359 cpu_to_le16(WLAN_EID_HT_INFORMATION
);
360 ht_info
->header
.len
=
361 cpu_to_le16(sizeof(struct ieee80211_ht_info
));
363 memcpy((u8
*) ht_info
+
364 sizeof(struct mwifiex_ie_types_header
),
365 (u8
*) bss_desc
->bcn_ht_info
+
366 sizeof(struct ieee_types_header
),
367 le16_to_cpu(ht_info
->header
.len
));
369 if (!(sband
->ht_cap
.cap
&
370 IEEE80211_HT_CAP_SUP_WIDTH_20_40
))
371 ht_info
->ht_info
.ht_param
&=
372 ~(IEEE80211_HT_PARAM_CHAN_WIDTH_ANY
|
373 IEEE80211_HT_PARAM_CHA_SEC_OFFSET
);
375 *buffer
+= sizeof(struct mwifiex_ie_types_htinfo
);
376 ret_len
+= sizeof(struct mwifiex_ie_types_htinfo
);
380 (struct mwifiex_ie_types_chan_list_param_set
*) *buffer
;
382 sizeof(struct mwifiex_ie_types_chan_list_param_set
));
383 chan_list
->header
.type
= cpu_to_le16(TLV_TYPE_CHANLIST
);
384 chan_list
->header
.len
= cpu_to_le16(
385 sizeof(struct mwifiex_ie_types_chan_list_param_set
) -
386 sizeof(struct mwifiex_ie_types_header
));
387 chan_list
->chan_scan_param
[0].chan_number
=
388 bss_desc
->bcn_ht_info
->control_chan
;
389 chan_list
->chan_scan_param
[0].radio_type
=
390 mwifiex_band_to_radio_type((u8
) bss_desc
->bss_band
);
392 if (sband
->ht_cap
.cap
& IEEE80211_HT_CAP_SUP_WIDTH_20_40
&&
393 bss_desc
->bcn_ht_info
->ht_param
&
394 IEEE80211_HT_PARAM_CHAN_WIDTH_ANY
)
395 SET_SECONDARYCHAN(chan_list
->chan_scan_param
[0].
397 (bss_desc
->bcn_ht_info
->ht_param
&
398 IEEE80211_HT_PARAM_CHA_SEC_OFFSET
));
400 *buffer
+= sizeof(struct mwifiex_ie_types_chan_list_param_set
);
401 ret_len
+= sizeof(struct mwifiex_ie_types_chan_list_param_set
);
404 if (bss_desc
->bcn_bss_co_2040
) {
405 bss_co_2040
= (struct mwifiex_ie_types_2040bssco
*) *buffer
;
406 memset(bss_co_2040
, 0,
407 sizeof(struct mwifiex_ie_types_2040bssco
));
408 bss_co_2040
->header
.type
= cpu_to_le16(WLAN_EID_BSS_COEX_2040
);
409 bss_co_2040
->header
.len
=
410 cpu_to_le16(sizeof(bss_co_2040
->bss_co_2040
));
412 memcpy((u8
*) bss_co_2040
+
413 sizeof(struct mwifiex_ie_types_header
),
414 (u8
*) bss_desc
->bcn_bss_co_2040
+
415 sizeof(struct ieee_types_header
),
416 le16_to_cpu(bss_co_2040
->header
.len
));
418 *buffer
+= sizeof(struct mwifiex_ie_types_2040bssco
);
419 ret_len
+= sizeof(struct mwifiex_ie_types_2040bssco
);
422 if (bss_desc
->bcn_ext_cap
) {
423 ext_cap
= (struct mwifiex_ie_types_extcap
*) *buffer
;
424 memset(ext_cap
, 0, sizeof(struct mwifiex_ie_types_extcap
));
425 ext_cap
->header
.type
= cpu_to_le16(WLAN_EID_EXT_CAPABILITY
);
426 ext_cap
->header
.len
= cpu_to_le16(sizeof(ext_cap
->ext_cap
));
428 memcpy((u8
*) ext_cap
+
429 sizeof(struct mwifiex_ie_types_header
),
430 (u8
*) bss_desc
->bcn_ext_cap
+
431 sizeof(struct ieee_types_header
),
432 le16_to_cpu(ext_cap
->header
.len
));
434 *buffer
+= sizeof(struct mwifiex_ie_types_extcap
);
435 ret_len
+= sizeof(struct mwifiex_ie_types_extcap
);
442 * This function reconfigures the Tx buffer size in firmware.
444 * This function prepares a firmware command and issues it, if
445 * the current Tx buffer size is different from the one requested.
446 * Maximum configurable Tx buffer size is limited by the HT capability
450 mwifiex_cfg_tx_buf(struct mwifiex_private
*priv
,
451 struct mwifiex_bssdescriptor
*bss_desc
)
453 u16 max_amsdu
= MWIFIEX_TX_DATA_BUF_SIZE_2K
;
454 u16 tx_buf
, curr_tx_buf_size
= 0;
456 if (bss_desc
->bcn_ht_cap
) {
457 if (le16_to_cpu(bss_desc
->bcn_ht_cap
->cap_info
) &
458 IEEE80211_HT_CAP_MAX_AMSDU
)
459 max_amsdu
= MWIFIEX_TX_DATA_BUF_SIZE_8K
;
461 max_amsdu
= MWIFIEX_TX_DATA_BUF_SIZE_4K
;
464 tx_buf
= min(priv
->adapter
->max_tx_buf_size
, max_amsdu
);
466 dev_dbg(priv
->adapter
->dev
, "info: max_amsdu=%d, max_tx_buf=%d\n",
467 max_amsdu
, priv
->adapter
->max_tx_buf_size
);
469 if (priv
->adapter
->curr_tx_buf_size
<= MWIFIEX_TX_DATA_BUF_SIZE_2K
)
470 curr_tx_buf_size
= MWIFIEX_TX_DATA_BUF_SIZE_2K
;
471 else if (priv
->adapter
->curr_tx_buf_size
<= MWIFIEX_TX_DATA_BUF_SIZE_4K
)
472 curr_tx_buf_size
= MWIFIEX_TX_DATA_BUF_SIZE_4K
;
473 else if (priv
->adapter
->curr_tx_buf_size
<= MWIFIEX_TX_DATA_BUF_SIZE_8K
)
474 curr_tx_buf_size
= MWIFIEX_TX_DATA_BUF_SIZE_8K
;
475 if (curr_tx_buf_size
!= tx_buf
)
476 mwifiex_send_cmd_async(priv
, HostCmd_CMD_RECONFIGURE_TX_BUFF
,
477 HostCmd_ACT_GEN_SET
, 0, &tx_buf
);
481 * This function checks if the given pointer is valid entry of
482 * Tx BA Stream table.
484 static int mwifiex_is_tx_ba_stream_ptr_valid(struct mwifiex_private
*priv
,
485 struct mwifiex_tx_ba_stream_tbl
*tx_tbl_ptr
)
487 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tsr_tbl
;
489 list_for_each_entry(tx_ba_tsr_tbl
, &priv
->tx_ba_stream_tbl_ptr
, list
) {
490 if (tx_ba_tsr_tbl
== tx_tbl_ptr
)
498 * This function deletes the given entry in Tx BA Stream table.
500 * The function also performs a validity check on the supplied
501 * pointer before trying to delete.
503 void mwifiex_11n_delete_tx_ba_stream_tbl_entry(struct mwifiex_private
*priv
,
504 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tsr_tbl
)
506 if (!tx_ba_tsr_tbl
&&
507 mwifiex_is_tx_ba_stream_ptr_valid(priv
, tx_ba_tsr_tbl
))
510 dev_dbg(priv
->adapter
->dev
, "info: tx_ba_tsr_tbl %p\n", tx_ba_tsr_tbl
);
512 list_del(&tx_ba_tsr_tbl
->list
);
514 kfree(tx_ba_tsr_tbl
);
518 * This function deletes all the entries in Tx BA Stream table.
520 void mwifiex_11n_delete_all_tx_ba_stream_tbl(struct mwifiex_private
*priv
)
523 struct mwifiex_tx_ba_stream_tbl
*del_tbl_ptr
, *tmp_node
;
526 spin_lock_irqsave(&priv
->tx_ba_stream_tbl_lock
, flags
);
527 list_for_each_entry_safe(del_tbl_ptr
, tmp_node
,
528 &priv
->tx_ba_stream_tbl_ptr
, list
)
529 mwifiex_11n_delete_tx_ba_stream_tbl_entry(priv
, del_tbl_ptr
);
530 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
, flags
);
532 INIT_LIST_HEAD(&priv
->tx_ba_stream_tbl_ptr
);
534 for (i
= 0; i
< MAX_NUM_TID
; ++i
)
535 priv
->aggr_prio_tbl
[i
].ampdu_ap
=
536 priv
->aggr_prio_tbl
[i
].ampdu_user
;
540 * This function returns the pointer to an entry in BA Stream
541 * table which matches the given RA/TID pair.
543 struct mwifiex_tx_ba_stream_tbl
*
544 mwifiex_get_ba_tbl(struct mwifiex_private
*priv
, int tid
, u8
*ra
)
546 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tsr_tbl
;
549 spin_lock_irqsave(&priv
->tx_ba_stream_tbl_lock
, flags
);
550 list_for_each_entry(tx_ba_tsr_tbl
, &priv
->tx_ba_stream_tbl_ptr
, list
) {
551 if (!memcmp(tx_ba_tsr_tbl
->ra
, ra
, ETH_ALEN
) &&
552 tx_ba_tsr_tbl
->tid
== tid
) {
553 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
,
555 return tx_ba_tsr_tbl
;
558 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
, flags
);
563 * This function creates an entry in Tx BA stream table for the
566 void mwifiex_create_ba_tbl(struct mwifiex_private
*priv
, u8
*ra
, int tid
,
567 enum mwifiex_ba_status ba_status
)
569 struct mwifiex_tx_ba_stream_tbl
*new_node
;
572 if (!mwifiex_get_ba_tbl(priv
, tid
, ra
)) {
573 new_node
= kzalloc(sizeof(struct mwifiex_tx_ba_stream_tbl
),
576 dev_err(priv
->adapter
->dev
,
577 "%s: failed to alloc new_node\n", __func__
);
581 INIT_LIST_HEAD(&new_node
->list
);
584 new_node
->ba_status
= ba_status
;
585 memcpy(new_node
->ra
, ra
, ETH_ALEN
);
587 spin_lock_irqsave(&priv
->tx_ba_stream_tbl_lock
, flags
);
588 list_add_tail(&new_node
->list
, &priv
->tx_ba_stream_tbl_ptr
);
589 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
, flags
);
594 * This function sends an add BA request to the given TID/RA pair.
596 int mwifiex_send_addba(struct mwifiex_private
*priv
, int tid
, u8
*peer_mac
)
598 struct host_cmd_ds_11n_addba_req add_ba_req
;
599 static u8 dialog_tok
;
602 dev_dbg(priv
->adapter
->dev
, "cmd: %s: tid %d\n", __func__
, tid
);
604 add_ba_req
.block_ack_param_set
= cpu_to_le16(
605 (u16
) ((tid
<< BLOCKACKPARAM_TID_POS
) |
607 tx_win_size
<< BLOCKACKPARAM_WINSIZE_POS
) |
608 IMMEDIATE_BLOCK_ACK
));
609 add_ba_req
.block_ack_tmo
= cpu_to_le16((u16
)priv
->add_ba_param
.timeout
);
616 add_ba_req
.dialog_token
= dialog_tok
;
617 memcpy(&add_ba_req
.peer_mac_addr
, peer_mac
, ETH_ALEN
);
619 /* We don't wait for the response of this command */
620 ret
= mwifiex_send_cmd_async(priv
, HostCmd_CMD_11N_ADDBA_REQ
,
627 * This function sends a delete BA request to the given TID/RA pair.
629 int mwifiex_send_delba(struct mwifiex_private
*priv
, int tid
, u8
*peer_mac
,
632 struct host_cmd_ds_11n_delba delba
;
634 uint16_t del_ba_param_set
;
636 memset(&delba
, 0, sizeof(delba
));
637 delba
.del_ba_param_set
= cpu_to_le16(tid
<< DELBA_TID_POS
);
639 del_ba_param_set
= le16_to_cpu(delba
.del_ba_param_set
);
641 del_ba_param_set
|= IEEE80211_DELBA_PARAM_INITIATOR_MASK
;
643 del_ba_param_set
&= ~IEEE80211_DELBA_PARAM_INITIATOR_MASK
;
645 memcpy(&delba
.peer_mac_addr
, peer_mac
, ETH_ALEN
);
647 /* We don't wait for the response of this command */
648 ret
= mwifiex_send_cmd_async(priv
, HostCmd_CMD_11N_DELBA
,
649 HostCmd_ACT_GEN_SET
, 0, &delba
);
655 * This function handles the command response of a delete BA request.
657 void mwifiex_11n_delete_ba_stream(struct mwifiex_private
*priv
, u8
*del_ba
)
659 struct host_cmd_ds_11n_delba
*cmd_del_ba
=
660 (struct host_cmd_ds_11n_delba
*) del_ba
;
661 uint16_t del_ba_param_set
= le16_to_cpu(cmd_del_ba
->del_ba_param_set
);
664 tid
= del_ba_param_set
>> DELBA_TID_POS
;
666 mwifiex_del_ba_tbl(priv
, tid
, cmd_del_ba
->peer_mac_addr
,
667 TYPE_DELBA_RECEIVE
, INITIATOR_BIT(del_ba_param_set
));
671 * This function retrieves the Rx reordering table.
673 int mwifiex_get_rx_reorder_tbl(struct mwifiex_private
*priv
,
674 struct mwifiex_ds_rx_reorder_tbl
*buf
)
677 struct mwifiex_ds_rx_reorder_tbl
*rx_reo_tbl
= buf
;
678 struct mwifiex_rx_reorder_tbl
*rx_reorder_tbl_ptr
;
682 spin_lock_irqsave(&priv
->rx_reorder_tbl_lock
, flags
);
683 list_for_each_entry(rx_reorder_tbl_ptr
, &priv
->rx_reorder_tbl_ptr
,
685 rx_reo_tbl
->tid
= (u16
) rx_reorder_tbl_ptr
->tid
;
686 memcpy(rx_reo_tbl
->ta
, rx_reorder_tbl_ptr
->ta
, ETH_ALEN
);
687 rx_reo_tbl
->start_win
= rx_reorder_tbl_ptr
->start_win
;
688 rx_reo_tbl
->win_size
= rx_reorder_tbl_ptr
->win_size
;
689 for (i
= 0; i
< rx_reorder_tbl_ptr
->win_size
; ++i
) {
690 if (rx_reorder_tbl_ptr
->rx_reorder_ptr
[i
])
691 rx_reo_tbl
->buffer
[i
] = true;
693 rx_reo_tbl
->buffer
[i
] = false;
698 if (count
>= MWIFIEX_MAX_RX_BASTREAM_SUPPORTED
)
701 spin_unlock_irqrestore(&priv
->rx_reorder_tbl_lock
, flags
);
707 * This function retrieves the Tx BA stream table.
709 int mwifiex_get_tx_ba_stream_tbl(struct mwifiex_private
*priv
,
710 struct mwifiex_ds_tx_ba_stream_tbl
*buf
)
712 struct mwifiex_tx_ba_stream_tbl
*tx_ba_tsr_tbl
;
713 struct mwifiex_ds_tx_ba_stream_tbl
*rx_reo_tbl
= buf
;
717 spin_lock_irqsave(&priv
->tx_ba_stream_tbl_lock
, flags
);
718 list_for_each_entry(tx_ba_tsr_tbl
, &priv
->tx_ba_stream_tbl_ptr
, list
) {
719 rx_reo_tbl
->tid
= (u16
) tx_ba_tsr_tbl
->tid
;
720 dev_dbg(priv
->adapter
->dev
, "data: %s tid=%d\n",
721 __func__
, rx_reo_tbl
->tid
);
722 memcpy(rx_reo_tbl
->ra
, tx_ba_tsr_tbl
->ra
, ETH_ALEN
);
725 if (count
>= MWIFIEX_MAX_TX_BASTREAM_SUPPORTED
)
728 spin_unlock_irqrestore(&priv
->tx_ba_stream_tbl_lock
, flags
);