mochabin/mwifiex
1
0
Fork 0
mirror of https://github.com/nxp-imx/mwifiex.git synced 2024-10-31 21:15:22 +00:00
Code Issues Projects Releases Packages Wiki Activity
mwifiex/mxm_wifiex/wlan_src/mlan/mlan_11n_rxreorder.c
Sherry Sun 983c0739ec mxm_wifiex: update to mxm6x17423.p1 release 
Corresponding firmware version:
SDIO-UART W8987 Firmware version 16.92.21.p99.2
PCIE-UART W8997 Firmware version 16.92.21.p84.4
SDIO-UART W8997 Firmware version 16.92.21.p84.4
SDIO-UART IW416 Firmware version 16.92.21.p84.128
SDIO_UART IW612 Firmware version 18.99.2.p66
SDIO-UART W8801 Firmware version 14.92.36.p186
SDIO-UART W9098 Firmware version 17.92.1.p136.131
PCIE-UART W9098 Firmware version 17.92.1.p136.131

Signed-off-by: Sherry Sun <sherry.sun@nxp.com>
2023-10-07 11:16:22 +08:00

1614 lines
46 KiB
C
Raw Blame History

/** @file mlan_11n_rxreorder.c
*
* @brief This file contains the handling of RxReordering in wlan
* driver.
*
*
* Copyright 2008-2021 NXP
*
* This software file (the File) is distributed by NXP
* under the terms of the GNU General Public License Version 2, June 1991
* (the License). You may use, redistribute and/or modify the File in
* accordance with the terms and conditions of the License, a copy of which
* is available by writing to the Free Software Foundation, Inc.,
* 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA or on the
* worldwide web at http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt.
*
* THE FILE IS DISTRIBUTED AS-IS, WITHOUT WARRANTY OF ANY KIND, AND THE
* IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A PARTICULAR PURPOSE
* ARE EXPRESSLY DISCLAIMED. The License provides additional details about
* this warranty disclaimer.
*
*/
/********************************************************
Change log:
11/10/2008: initial version
********************************************************/
#include "mlan.h"
#include "mlan_join.h"
#include "mlan_util.h"
#include "mlan_fw.h"
#include "mlan_main.h"
#include "mlan_wmm.h"
#include "mlan_11n.h"
#include "mlan_11n_rxreorder.h"
/********************************************************
Local Variables
********************************************************/
/********************************************************
Global Variables
********************************************************/
/********************************************************
Local Functions
********************************************************/
/**
* @brief This function will dispatch amsdu packet and
* forward it to kernel/upper layer
*
* @param priv A pointer to mlan_private
* @param pmbuf A pointer to the received buffer
*
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
*/
static mlan_status wlan_11n_dispatch_amsdu_pkt(mlan_private *priv,
pmlan_buffer pmbuf)
{
RxPD *prx_pd;
prx_pd = (RxPD *)(pmbuf->pbuf + pmbuf->data_offset);
ENTER();
if (prx_pd->rx_pkt_type == PKT_TYPE_AMSDU) {
pmbuf->data_len = prx_pd->rx_pkt_length;
pmbuf->data_offset += prx_pd->rx_pkt_offset;
wlan_11n_deaggregate_pkt(priv, pmbuf);
LEAVE();
return MLAN_STATUS_SUCCESS;
}
LEAVE();
return MLAN_STATUS_FAILURE;
}
/**
* @brief This function will process the rx packet and
* forward it to kernel/upper layer
*
* @param priv A pointer to mlan_private
* @param payload A pointer to rx packet payload
* @param rx_reor_tbl_ptr pointer to RxReorderTbl
*
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
*/
static mlan_status wlan_11n_dispatch_pkt(t_void *priv, t_void *payload,
RxReorderTbl *rx_reor_tbl_ptr)
{
mlan_status ret = MLAN_STATUS_SUCCESS;
#ifdef STA_SUPPORT
pmlan_adapter pmadapter = ((pmlan_private)priv)->adapter;
#endif
ENTER();
if (payload == (t_void *)RX_PKT_DROPPED_IN_FW) {
LEAVE();
return ret;
}
#ifdef UAP_SUPPORT
if (GET_BSS_ROLE((mlan_private *)priv) == MLAN_BSS_ROLE_UAP) {
if (MLAN_STATUS_SUCCESS ==
wlan_11n_dispatch_amsdu_pkt((mlan_private *)priv,
(pmlan_buffer)payload)) {
LEAVE();
return ret;
}
ret = wlan_process_uap_rx_packet(priv, (pmlan_buffer)payload);
LEAVE();
return ret;
}
#endif /* UAP_SUPPORT */
#ifdef STA_SUPPORT
if (MLAN_STATUS_SUCCESS ==
wlan_11n_dispatch_amsdu_pkt((mlan_private *)priv,
(pmlan_buffer)payload)) {
LEAVE();
return ret;
}
ret = wlan_process_rx_packet(pmadapter, (pmlan_buffer)payload);
#endif /* STA_SUPPORT */
LEAVE();
return ret;
}
/**
* @brief This function restarts the reordering timeout timer
*
* @param pmadapter A pointer to mlan_adapter
* @param rx_reor_tbl_ptr A pointer to structure RxReorderTbl
*
* @return N/A
*/
static void mlan_11n_rxreorder_timer_restart(pmlan_adapter pmadapter,
RxReorderTbl *rx_reor_tbl_ptr)
{
t_u16 min_flush_time = pmadapter->flush_time_ac_be_bk;
mlan_wmm_ac_e wmm_ac;
ENTER();
wmm_ac = wlan_wmm_convert_tos_to_ac(pmadapter, rx_reor_tbl_ptr->tid);
if ((WMM_AC_VI == wmm_ac) || (WMM_AC_VO == wmm_ac))
min_flush_time = pmadapter->flush_time_ac_vi_vo;
if (rx_reor_tbl_ptr->timer_context.timer_is_set)
pmadapter->callbacks.moal_stop_timer(
pmadapter->pmoal_handle,
rx_reor_tbl_ptr->timer_context.timer);
pmadapter->callbacks.moal_start_timer(
pmadapter->pmoal_handle, rx_reor_tbl_ptr->timer_context.timer,
MFALSE, min_flush_time);
rx_reor_tbl_ptr->timer_context.timer_is_set = MTRUE;
LEAVE();
}
/**
* @brief This function dispatches all the packets in the buffer.
* There could be holes in the buffer.
*
* @param priv A pointer to mlan_private
* @param rx_reor_tbl_ptr A pointer to structure RxReorderTbl
* @param start_win Start window
*
* @return MLAN_STATUS_SUCCESS
*/
static mlan_status wlan_11n_dispatch_pkt_until_start_win(
t_void *priv, RxReorderTbl *rx_reor_tbl_ptr, int start_win)
{
t_u32 no_pkt_to_send, i, xchg;
mlan_status ret = MLAN_STATUS_SUCCESS;
void *rx_tmp_ptr = MNULL;
mlan_private *pmpriv = (mlan_private *)priv;
ENTER();
no_pkt_to_send = (start_win > rx_reor_tbl_ptr->start_win) ?
MIN((start_win - rx_reor_tbl_ptr->start_win),
rx_reor_tbl_ptr->win_size) :
rx_reor_tbl_ptr->win_size;
for (i = 0; i < no_pkt_to_send; ++i) {
pmpriv->adapter->callbacks.moal_spin_lock(
pmpriv->adapter->pmoal_handle, pmpriv->rx_pkt_lock);
rx_tmp_ptr = MNULL;
if (rx_reor_tbl_ptr->rx_reorder_ptr[i]) {
rx_tmp_ptr = rx_reor_tbl_ptr->rx_reorder_ptr[i];
rx_reor_tbl_ptr->rx_reorder_ptr[i] = MNULL;
}
pmpriv->adapter->callbacks.moal_spin_unlock(
pmpriv->adapter->pmoal_handle, pmpriv->rx_pkt_lock);
if (rx_tmp_ptr)
wlan_11n_dispatch_pkt(priv, rx_tmp_ptr,
rx_reor_tbl_ptr);
}
pmpriv->adapter->callbacks.moal_spin_lock(pmpriv->adapter->pmoal_handle,
pmpriv->rx_pkt_lock);
/*
* We don't have a circular buffer, hence use rotation to simulate
* circular buffer
*/
xchg = rx_reor_tbl_ptr->win_size - no_pkt_to_send;
for (i = 0; i < xchg; ++i) {
rx_reor_tbl_ptr->rx_reorder_ptr[i] =
rx_reor_tbl_ptr->rx_reorder_ptr[no_pkt_to_send + i];
rx_reor_tbl_ptr->rx_reorder_ptr[no_pkt_to_send + i] = MNULL;
}
/* clear the bits of reorder bitmap that has been dispatched */
if (no_pkt_to_send < (8 * (sizeof(rx_reor_tbl_ptr->bitmap))))
rx_reor_tbl_ptr->bitmap =
rx_reor_tbl_ptr->bitmap >> no_pkt_to_send;
else
rx_reor_tbl_ptr->bitmap = 0;
rx_reor_tbl_ptr->start_win = start_win;
pmpriv->adapter->callbacks.moal_spin_unlock(
pmpriv->adapter->pmoal_handle, pmpriv->rx_pkt_lock);
LEAVE();
return ret;
}
/**
* @brief This function will display the rxReorder table
*
* @param pmadapter A pointer to mlan_adapter structure
* @param rx_reor_tbl_ptr A pointer to structure RxReorderTbl
*
* @return N/A
*/
static t_void wlan_11n_display_tbl_ptr(pmlan_adapter pmadapter,
RxReorderTbl *rx_reor_tbl_ptr)
{
ENTER();
DBG_HEXDUMP(MDAT_D, "Reorder ptr", rx_reor_tbl_ptr->rx_reorder_ptr,
sizeof(t_void *) * rx_reor_tbl_ptr->win_size);
LEAVE();
}
/**
* @brief This function will dispatch all packets sequentially
* from start_win until a hole is found and adjust the
* start_win appropriately
*
* @param priv A pointer to mlan_private
* @param rx_reor_tbl_ptr A pointer to structure RxReorderTbl
*
* @return MLAN_STATUS_SUCCESS
*/
static mlan_status wlan_11n_scan_and_dispatch(t_void *priv,
RxReorderTbl *rx_reor_tbl_ptr)
{
int i, j, xchg;
mlan_status ret = MLAN_STATUS_SUCCESS;
void *rx_tmp_ptr = MNULL;
mlan_private *pmpriv = (mlan_private *)priv;
ENTER();
for (i = 0; i < rx_reor_tbl_ptr->win_size; ++i) {
pmpriv->adapter->callbacks.moal_spin_lock(
pmpriv->adapter->pmoal_handle, pmpriv->rx_pkt_lock);
if (!rx_reor_tbl_ptr->rx_reorder_ptr[i]) {
pmpriv->adapter->callbacks.moal_spin_unlock(
pmpriv->adapter->pmoal_handle,
pmpriv->rx_pkt_lock);
break;
}
rx_tmp_ptr = rx_reor_tbl_ptr->rx_reorder_ptr[i];
rx_reor_tbl_ptr->rx_reorder_ptr[i] = MNULL;
pmpriv->adapter->callbacks.moal_spin_unlock(
pmpriv->adapter->pmoal_handle, pmpriv->rx_pkt_lock);
wlan_11n_dispatch_pkt(priv, rx_tmp_ptr, rx_reor_tbl_ptr);
}
pmpriv->adapter->callbacks.moal_spin_lock(pmpriv->adapter->pmoal_handle,
pmpriv->rx_pkt_lock);
/*
* We don't have a circular buffer, hence use rotation to simulate
* circular buffer
*/
if (i > 0) {
xchg = rx_reor_tbl_ptr->win_size - i;
for (j = 0; j < xchg; ++j) {
rx_reor_tbl_ptr->rx_reorder_ptr[j] =
rx_reor_tbl_ptr->rx_reorder_ptr[i + j];
rx_reor_tbl_ptr->rx_reorder_ptr[i + j] = MNULL;
}
}
/* clear the bits of reorder bitmap that has been dispatched */
if (i < (8 * sizeof(rx_reor_tbl_ptr->bitmap)))
rx_reor_tbl_ptr->bitmap = rx_reor_tbl_ptr->bitmap >> i;
else
rx_reor_tbl_ptr->bitmap = 0;
rx_reor_tbl_ptr->start_win =
(rx_reor_tbl_ptr->start_win + i) & (MAX_TID_VALUE - 1);
pmpriv->adapter->callbacks.moal_spin_unlock(
pmpriv->adapter->pmoal_handle, pmpriv->rx_pkt_lock);
LEAVE();
return ret;
}
/**
* @brief This function delete rxreorder table's entry
* and free the memory
*
* @param priv A pointer to mlan_private
* @param rx_reor_tbl_ptr A pointer to structure RxReorderTbl
*
* @return N/A
*/
static t_void wlan_11n_delete_rxreorder_tbl_entry(mlan_private *priv,
RxReorderTbl *rx_reor_tbl_ptr)
{
pmlan_adapter pmadapter = priv->adapter;
ENTER();
if (!rx_reor_tbl_ptr) {
LEAVE();
return;
}
mlan_block_rx_process(pmadapter, MTRUE);
wlan_11n_dispatch_pkt_until_start_win(
priv, rx_reor_tbl_ptr,
(rx_reor_tbl_ptr->start_win + rx_reor_tbl_ptr->win_size) &
(MAX_TID_VALUE - 1));
if (rx_reor_tbl_ptr->timer_context.timer) {
if (rx_reor_tbl_ptr->timer_context.timer_is_set) {
priv->adapter->callbacks.moal_stop_timer(
pmadapter->pmoal_handle,
rx_reor_tbl_ptr->timer_context.timer);
rx_reor_tbl_ptr->timer_context.timer_is_set = MFALSE;
}
priv->adapter->callbacks.moal_free_timer(
pmadapter->pmoal_handle,
rx_reor_tbl_ptr->timer_context.timer);
rx_reor_tbl_ptr->timer_context.timer = MNULL;
}
PRINTM(MDAT_D, "Delete rx_reor_tbl_ptr: %p\n", rx_reor_tbl_ptr);
util_unlink_list(pmadapter->pmoal_handle, &priv->rx_reorder_tbl_ptr,
(pmlan_linked_list)rx_reor_tbl_ptr,
pmadapter->callbacks.moal_spin_lock,
pmadapter->callbacks.moal_spin_unlock);
pmadapter->callbacks.moal_mfree(
pmadapter->pmoal_handle,
(t_u8 *)rx_reor_tbl_ptr->rx_reorder_ptr);
pmadapter->callbacks.moal_mfree(pmadapter->pmoal_handle,
(t_u8 *)rx_reor_tbl_ptr);
mlan_block_rx_process(pmadapter, MFALSE);
LEAVE();
}
/**
* @brief This function returns the last used sequence number
*
* @param rx_reorder_tbl_ptr A pointer to structure RxReorderTbl
*
* @return Last used sequence number
*/
static int wlan_11n_find_last_seqnum(RxReorderTbl *rx_reorder_tbl_ptr)
{
int i;
ENTER();
for (i = (rx_reorder_tbl_ptr->win_size - 1); i >= 0; --i) {
if (rx_reorder_tbl_ptr->rx_reorder_ptr[i]) {
LEAVE();
return i;
}
}
LEAVE();
return -1;
}
/**
* @brief This function flushes all data
*
* @param priv A pointer to mlan_private structure
* @param rx_reor_tbl_ptr A pointer to RxReorderTbl
*
* @return N/A
*/
static t_void wlan_start_flush_data(mlan_private *priv,
RxReorderTbl *rx_reor_tbl_ptr)
{
int startWin;
ENTER();
wlan_11n_display_tbl_ptr(priv->adapter, rx_reor_tbl_ptr);
startWin = wlan_11n_find_last_seqnum(rx_reor_tbl_ptr);
if (startWin >= 0) {
PRINTM(MINFO, "Flush data %d\n", startWin);
wlan_11n_dispatch_pkt_until_start_win(
priv, rx_reor_tbl_ptr,
((rx_reor_tbl_ptr->start_win + startWin + 1) &
(MAX_TID_VALUE - 1)));
}
wlan_11n_display_tbl_ptr(priv->adapter, rx_reor_tbl_ptr);
LEAVE();
}
/**
* @brief This function set the flag to flushes data
*
* @param context Reorder context pointer
*
* @return N/A
*/
static t_void wlan_flush_data(t_void *context)
{
reorder_tmr_cnxt_t *reorder_cnxt = (reorder_tmr_cnxt_t *)context;
ENTER();
/* Set the flag to flush data */
reorder_cnxt->priv->adapter->flush_data = MTRUE;
reorder_cnxt->ptr->flush_data = MTRUE;
reorder_cnxt->timer_is_set = MFALSE;
wlan_recv_event(reorder_cnxt->priv, MLAN_EVENT_ID_DRV_DEFER_RX_WORK,
MNULL);
LEAVE();
}
/**
* @brief This function will create a entry in rx reordering table for the
* given ta/tid and will initialize it with seq_num, win_size
*
* @param priv A pointer to mlan_private
* @param ta ta to find in reordering table
* @param tid tid to find in reordering table
* @param win_size win_size for the give ta/tid pair.
* @param seq_num Starting sequence number for current entry.
*
* @return N/A
*/
static t_void wlan_11n_create_rxreorder_tbl(mlan_private *priv, t_u8 *ta,
int tid, int win_size, int seq_num)
{
int i;
pmlan_adapter pmadapter = priv->adapter;
RxReorderTbl *rx_reor_tbl_ptr, *new_node;
sta_node *sta_ptr = MNULL;
t_u16 last_seq = 0;
ENTER();
/*
* If we get a TID, ta pair which is already present dispatch all the
* the packets and move the window size until the ssn
*/
rx_reor_tbl_ptr = wlan_11n_get_rxreorder_tbl(priv, tid, ta);
if (rx_reor_tbl_ptr) {
PRINTM(MCMND, "%s: delete %p old_size=%d, win_size=%d\n",
__func__, rx_reor_tbl_ptr, rx_reor_tbl_ptr->win_size,
win_size);
wlan_11n_delete_rxreorder_tbl_entry(priv, rx_reor_tbl_ptr);
}
mlan_block_rx_process(pmadapter, MTRUE);
PRINTM(MCMND, "%s: seq_num %d, tid %d, ta " MACSTR ", win_size %d\n",
__func__, seq_num, tid, MAC2STR(ta), win_size);
if (pmadapter->callbacks.moal_malloc(pmadapter->pmoal_handle,
sizeof(RxReorderTbl), MLAN_MEM_DEF,
(t_u8 **)&new_node)) {
PRINTM(MERROR, "Rx reorder memory allocation failed\n");
mlan_block_rx_process(pmadapter, MFALSE);
LEAVE();
return;
}
util_init_list((pmlan_linked_list)new_node);
if (pmadapter->callbacks.moal_malloc(
pmadapter->pmoal_handle, sizeof(pmlan_buffer) * win_size,
MLAN_MEM_DEF, (t_u8 **)&new_node->rx_reorder_ptr)) {
PRINTM(MERROR, "Rx reorder table memory allocation"
"failed\n");
pmadapter->callbacks.moal_mfree(pmadapter->pmoal_handle,
(t_u8 *)new_node);
mlan_block_rx_process(pmadapter, MFALSE);
LEAVE();
return;
}
PRINTM(MDAT_D, "Create ReorderPtr: %p start_win=%d last_seq=%d\n",
new_node, new_node->start_win, last_seq);
new_node->timer_context.ptr = new_node;
new_node->timer_context.priv = priv;
new_node->timer_context.timer_is_set = MFALSE;
pmadapter->callbacks.moal_init_timer(pmadapter->pmoal_handle,
&new_node->timer_context.timer,
wlan_flush_data,
&new_node->timer_context);
util_enqueue_list_tail(pmadapter->pmoal_handle,
&priv->rx_reorder_tbl_ptr,
(pmlan_linked_list)new_node,
pmadapter->callbacks.moal_spin_lock,
pmadapter->callbacks.moal_spin_unlock);
new_node->tid = tid;
memcpy_ext(pmadapter, new_node->ta, ta, MLAN_MAC_ADDR_LENGTH,
MLAN_MAC_ADDR_LENGTH);
new_node->start_win = seq_num;
new_node->pkt_count = 0;
if (queuing_ra_based(priv)) {
if (GET_BSS_ROLE(priv) == MLAN_BSS_ROLE_UAP) {
sta_ptr = wlan_get_station_entry(priv, ta);
if (sta_ptr)
last_seq = sta_ptr->rx_seq[tid];
}
PRINTM(MINFO, "UAP/ADHOC:last_seq=%d start_win=%d\n", last_seq,
new_node->start_win);
} else {
sta_ptr = wlan_get_station_entry(priv, ta);
if (sta_ptr)
last_seq = sta_ptr->rx_seq[tid];
else
last_seq = priv->rx_seq[tid];
}
new_node->last_seq = last_seq;
new_node->win_size = win_size;
new_node->force_no_drop = MFALSE;
new_node->check_start_win = MTRUE;
new_node->bitmap = 0;
new_node->ba_status = BA_STREAM_SETUP_INPROGRESS;
for (i = 0; i < win_size; ++i)
new_node->rx_reorder_ptr[i] = MNULL;
mlan_block_rx_process(pmadapter, MFALSE);
LEAVE();
}
/********************************************************
Global Functions
********************************************************/
/**
* @brief This function will return the pointer to a entry in rx reordering
* table which matches the give TA/TID pair
*
* @param priv A pointer to mlan_private
* @param ta ta to find in reordering table
* @param tid tid to find in reordering table
*
* @return A pointer to structure RxReorderTbl
*/
RxReorderTbl *wlan_11n_get_rxreorder_tbl(mlan_private *priv, int tid, t_u8 *ta)
{
RxReorderTbl *rx_reor_tbl_ptr;
ENTER();
rx_reor_tbl_ptr =
(RxReorderTbl *)util_peek_list(priv->adapter->pmoal_handle,
&priv->rx_reorder_tbl_ptr, MNULL,
MNULL);
if (!rx_reor_tbl_ptr) {
LEAVE();
return MNULL;
}
while (rx_reor_tbl_ptr != (RxReorderTbl *)&priv->rx_reorder_tbl_ptr) {
if ((!memcmp(priv->adapter, rx_reor_tbl_ptr->ta, ta,
MLAN_MAC_ADDR_LENGTH)) &&
(rx_reor_tbl_ptr->tid == tid)) {
LEAVE();
return rx_reor_tbl_ptr;
}
rx_reor_tbl_ptr = rx_reor_tbl_ptr->pnext;
}
LEAVE();
return MNULL;
}
/**
* @brief This function prepares command for adding a block ack
* request.
*
* @param priv A pointer to mlan_private structure
* @param cmd A pointer to HostCmd_DS_COMMAND structure
* @param pdata_buf A pointer to data buffer
*
* @return MLAN_STATUS_SUCCESS
*/
mlan_status wlan_cmd_11n_addba_req(mlan_private *priv, HostCmd_DS_COMMAND *cmd,
t_void *pdata_buf)
{
HostCmd_DS_11N_ADDBA_REQ *padd_ba_req =
(HostCmd_DS_11N_ADDBA_REQ *)&cmd->params.add_ba_req;
ENTER();
cmd->command = wlan_cpu_to_le16(HostCmd_CMD_11N_ADDBA_REQ);
cmd->size =
wlan_cpu_to_le16(sizeof(HostCmd_DS_11N_ADDBA_REQ) + S_DS_GEN);
memcpy_ext(priv->adapter, padd_ba_req, pdata_buf,
sizeof(HostCmd_DS_11N_ADDBA_REQ),
sizeof(HostCmd_DS_11N_ADDBA_REQ));
padd_ba_req->block_ack_param_set =
wlan_cpu_to_le16(padd_ba_req->block_ack_param_set);
padd_ba_req->block_ack_tmo =
wlan_cpu_to_le16(padd_ba_req->block_ack_tmo);
padd_ba_req->ssn = wlan_cpu_to_le16(padd_ba_req->ssn);
padd_ba_req->add_req_result = 0;
LEAVE();
return MLAN_STATUS_SUCCESS;
}
/**
* @brief This function check if AMPDU Rx allowed
*
* @param priv A pointer to mlan_private structure
* @param tid TID
*
* @return MTRUE/MFALSE
*/
static t_u8 wlan_is_addba_reject(mlan_private *priv, t_u8 tid)
{
if (tid >= MAX_NUM_TID) {
PRINTM(MERROR, "Wrong TID =%d", tid);
return ADDBA_RSP_STATUS_REJECT;
}
#ifdef STA_SUPPORT
#endif
return priv->addba_reject[tid];
}
/**
* @brief This function handles the command response of
* delete a block ack request
*
* @param priv A pointer to mlan_private structure
* @param addba A pointer to addba buffer
*
* @return N/A
*/
mlan_status wlan_11n_add_bastream(mlan_private *priv, t_u8 *addba)
{
HostCmd_DS_11N_ADDBA_REQ *pevt_addba_req =
(HostCmd_DS_11N_ADDBA_REQ *)addba;
RxReorderTbl *rx_reor_tbl_ptr = MNULL;
t_u16 block_ack_param_set;
mlan_status ret = MLAN_STATUS_SUCCESS;
int tid;
ENTER();
DBG_HEXDUMP(MCMD_D, "addba req", (t_u8 *)addba,
sizeof(HostCmd_DS_11N_ADDBA_REQ));
if (priv->adapter->scan_processing) {
PRINTM(MERROR,
"Scan in progress, ignore ADDBA Request event\n");
LEAVE();
return ret;
}
block_ack_param_set =
wlan_le16_to_cpu(pevt_addba_req->block_ack_param_set);
tid = (block_ack_param_set & BLOCKACKPARAM_TID_MASK) >>
BLOCKACKPARAM_TID_POS;
rx_reor_tbl_ptr = wlan_11n_get_rxreorder_tbl(
priv, tid, pevt_addba_req->peer_mac_addr);
if (rx_reor_tbl_ptr &&
(rx_reor_tbl_ptr->ba_status != BA_STREAM_SETUP_COMPLETE)) {
PRINTM(MCMND,
"BA setup in progress, ignore ADDBA Request event\n");
LEAVE();
return ret;
}
ret = wlan_prepare_cmd(priv, HostCmd_CMD_11N_ADDBA_RSP,
HostCmd_ACT_GEN_SET, 0, MNULL, addba);
LEAVE();
return ret;
}
/**
* @brief This function prepares command for adding a block ack
* response.
*
* @param priv A pointer to mlan_private structure
* @param cmd A pointer to HostCmd_DS_COMMAND structure
* @param pdata_buf A pointer to data buffer
*
* @return MLAN_STATUS_SUCCESS
*/
mlan_status wlan_cmd_11n_addba_rspgen(mlan_private *priv,
HostCmd_DS_COMMAND *cmd, void *pdata_buf)
{
HostCmd_DS_11N_ADDBA_RSP *padd_ba_rsp =
(HostCmd_DS_11N_ADDBA_RSP *)&cmd->params.add_ba_rsp;
HostCmd_DS_11N_ADDBA_REQ *pevt_addba_req =
(HostCmd_DS_11N_ADDBA_REQ *)pdata_buf;
t_u8 tid = 0;
t_u32 win_size = 0;
ENTER();
pevt_addba_req->block_ack_param_set =
wlan_le16_to_cpu(pevt_addba_req->block_ack_param_set);
pevt_addba_req->block_ack_tmo =
wlan_le16_to_cpu(pevt_addba_req->block_ack_tmo);
pevt_addba_req->ssn = wlan_le16_to_cpu(pevt_addba_req->ssn);
cmd->command = wlan_cpu_to_le16(HostCmd_CMD_11N_ADDBA_RSP);
cmd->size =
wlan_cpu_to_le16(sizeof(HostCmd_DS_11N_ADDBA_RSP) + S_DS_GEN);
memcpy_ext(priv->adapter, padd_ba_rsp->peer_mac_addr,
pevt_addba_req->peer_mac_addr, MLAN_MAC_ADDR_LENGTH,
MLAN_MAC_ADDR_LENGTH);
padd_ba_rsp->dialog_token = pevt_addba_req->dialog_token;
padd_ba_rsp->block_ack_tmo =
wlan_cpu_to_le16(pevt_addba_req->block_ack_tmo);
padd_ba_rsp->ssn = wlan_cpu_to_le16(pevt_addba_req->ssn);
padd_ba_rsp->add_rsp_result = 0;
padd_ba_rsp->block_ack_param_set = pevt_addba_req->block_ack_param_set;
tid = (padd_ba_rsp->block_ack_param_set & BLOCKACKPARAM_TID_MASK) >>
BLOCKACKPARAM_TID_POS;
if (wlan_is_addba_reject(priv, tid)
#ifdef STA_SUPPORT
|| ((GET_BSS_ROLE(priv) == MLAN_BSS_ROLE_STA) &&
priv->wps.session_enable)
#endif
#ifdef UAP_SUPPORT
|| ((GET_BSS_ROLE(priv) == MLAN_BSS_ROLE_UAP) &&
(util_scalar_read(priv->adapter->pmoal_handle,
&priv->adapter->pending_bridge_pkts,
priv->adapter->callbacks.moal_spin_lock,
priv->adapter->callbacks.moal_spin_unlock) >
RX_LOW_THRESHOLD))
#endif
)
padd_ba_rsp->status_code =
wlan_cpu_to_le16(ADDBA_RSP_STATUS_DECLINED);
else
padd_ba_rsp->status_code =
wlan_cpu_to_le16(ADDBA_RSP_STATUS_ACCEPT);
win_size = (padd_ba_rsp->block_ack_param_set &
BLOCKACKPARAM_WINSIZE_MASK) >>
BLOCKACKPARAM_WINSIZE_POS;
padd_ba_rsp->block_ack_param_set &= ~BLOCKACKPARAM_WINSIZE_MASK;
if (!priv->add_ba_param.rx_amsdu)
/* We do not support AMSDU inside AMPDU, hence reset the bit */
padd_ba_rsp->block_ack_param_set &=
~BLOCKACKPARAM_AMSDU_SUPP_MASK;
/*cert failure observed due to BA setup failure
if win_size requested from client is 0 */
if (win_size)
win_size = MIN(win_size, priv->add_ba_param.rx_win_size);
else
win_size = priv->add_ba_param.rx_win_size;
padd_ba_rsp->block_ack_param_set |= win_size
<< BLOCKACKPARAM_WINSIZE_POS;
padd_ba_rsp->block_ack_param_set =
wlan_cpu_to_le16(padd_ba_rsp->block_ack_param_set);
if (padd_ba_rsp->status_code ==
wlan_cpu_to_le16(ADDBA_RSP_STATUS_ACCEPT))
wlan_11n_create_rxreorder_tbl(priv,
pevt_addba_req->peer_mac_addr,
tid, win_size,
pevt_addba_req->ssn);
LEAVE();
return MLAN_STATUS_SUCCESS;
}
/**
* @brief This function prepares command for deleting a block ack
* request.
*
* @param priv A pointer to mlan_private structure
* @param cmd A pointer to HostCmd_DS_COMMAND structure
* @param pdata_buf A pointer to data buffer
*
* @return MLAN_STATUS_SUCCESS
*/
mlan_status wlan_cmd_11n_delba(mlan_private *priv, HostCmd_DS_COMMAND *cmd,
void *pdata_buf)
{
HostCmd_DS_11N_DELBA *pdel_ba =
(HostCmd_DS_11N_DELBA *)&cmd->params.del_ba;
ENTER();
cmd->command = wlan_cpu_to_le16(HostCmd_CMD_11N_DELBA);
cmd->size = wlan_cpu_to_le16(sizeof(HostCmd_DS_11N_DELBA) + S_DS_GEN);
memcpy_ext(priv->adapter, pdel_ba, pdata_buf,
sizeof(HostCmd_DS_11N_DELBA), sizeof(HostCmd_DS_11N_DELBA));
pdel_ba->del_ba_param_set = wlan_cpu_to_le16(pdel_ba->del_ba_param_set);
pdel_ba->reason_code = wlan_cpu_to_le16(pdel_ba->reason_code);
pdel_ba->del_result = 0;
LEAVE();
return MLAN_STATUS_SUCCESS;
}
/**
* @brief This function will identify if RxReodering is needed for the packet
* and will do the reordering if required before sending it to kernel
*
* @param priv A pointer to mlan_private
* @param seq_num Seqence number of the current packet
* @param tid Tid of the current packet
* @param ta Transmiter address of the current packet
* @param pkt_type Packetype for the current packet (to identify if its a BAR)
* @param payload Pointer to the payload
*
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
*/
mlan_status mlan_11n_rxreorder_pkt(void *priv, t_u16 seq_num, t_u16 tid,
t_u8 *ta, t_u8 pkt_type, void *payload)
{
RxReorderTbl *rx_reor_tbl_ptr;
int prev_start_win, start_win, end_win, win_size;
mlan_status ret = MLAN_STATUS_SUCCESS;
pmlan_adapter pmadapter = ((mlan_private *)priv)->adapter;
ENTER();
rx_reor_tbl_ptr =
wlan_11n_get_rxreorder_tbl((mlan_private *)priv, tid, ta);
if (!rx_reor_tbl_ptr || rx_reor_tbl_ptr->win_size <= 1) {
if (pkt_type != PKT_TYPE_BAR)
wlan_11n_dispatch_pkt(priv, payload, rx_reor_tbl_ptr);
LEAVE();
return ret;
} else {
if (rx_reor_tbl_ptr->flush_data) {
rx_reor_tbl_ptr->flush_data = MFALSE;
wlan_start_flush_data(priv, rx_reor_tbl_ptr);
}
if ((pkt_type == PKT_TYPE_AMSDU) && !rx_reor_tbl_ptr->amsdu) {
wlan_11n_dispatch_pkt(priv, payload, rx_reor_tbl_ptr);
LEAVE();
return ret;
}
if (pkt_type == PKT_TYPE_BAR)
PRINTM(MDAT_D, "BAR ");
if (pkt_type == PKT_TYPE_AMSDU)
PRINTM(MDAT_D, "AMSDU ");
if (rx_reor_tbl_ptr->check_start_win) {
PRINTM(MDAT_D,
"0:seq_num %d start_win %d win_size %d last_seq %d\n",
seq_num, rx_reor_tbl_ptr->start_win,
rx_reor_tbl_ptr->win_size,
rx_reor_tbl_ptr->last_seq);
if (seq_num == rx_reor_tbl_ptr->start_win)
rx_reor_tbl_ptr->check_start_win = MFALSE;
else {
rx_reor_tbl_ptr->pkt_count++;
if (rx_reor_tbl_ptr->pkt_count <
(rx_reor_tbl_ptr->win_size / 2)) {
if (rx_reor_tbl_ptr->last_seq ==
seq_num) {
/** drop duplicate packet */
ret = MLAN_STATUS_FAILURE;
} else {
/** forward the packet to kernel
*/
rx_reor_tbl_ptr->last_seq =
seq_num;
if (pkt_type != PKT_TYPE_BAR)
wlan_11n_dispatch_pkt(
priv, payload,
rx_reor_tbl_ptr);
}
LEAVE();
return ret;
}
rx_reor_tbl_ptr->check_start_win = MFALSE;
if ((seq_num != rx_reor_tbl_ptr->start_win) &&
(rx_reor_tbl_ptr->last_seq !=
DEFAULT_SEQ_NUM)) {
end_win = (rx_reor_tbl_ptr->start_win +
rx_reor_tbl_ptr->win_size -
1) &
(MAX_TID_VALUE - 1);
if (((end_win >
rx_reor_tbl_ptr->start_win) &&
(rx_reor_tbl_ptr->last_seq >=
rx_reor_tbl_ptr->start_win) &&
(rx_reor_tbl_ptr->last_seq <
end_win)) ||
((end_win <
rx_reor_tbl_ptr->start_win) &&
((rx_reor_tbl_ptr->last_seq >=
rx_reor_tbl_ptr->start_win) ||
(rx_reor_tbl_ptr->last_seq <
end_win)))) {
PRINTM(MDAT_D,
"Update start_win: last_seq=%d, start_win=%d seq_num=%d\n",
rx_reor_tbl_ptr->last_seq,
rx_reor_tbl_ptr
->start_win,
seq_num);
rx_reor_tbl_ptr->start_win =
rx_reor_tbl_ptr
->last_seq +
1;
} else if ((seq_num <
rx_reor_tbl_ptr->start_win) &&
(seq_num >
rx_reor_tbl_ptr->last_seq)) {
PRINTM(MDAT_D,
"Update start_win: last_seq=%d, start_win=%d seq_num=%d\n",
rx_reor_tbl_ptr->last_seq,
rx_reor_tbl_ptr
->start_win,
seq_num);
rx_reor_tbl_ptr->start_win =
rx_reor_tbl_ptr
->last_seq +
1;
}
}
}
}
if (rx_reor_tbl_ptr->force_no_drop) {
wlan_11n_dispatch_pkt_until_start_win(
priv, rx_reor_tbl_ptr,
(rx_reor_tbl_ptr->start_win +
rx_reor_tbl_ptr->win_size) &
(MAX_TID_VALUE - 1));
if (pkt_type != PKT_TYPE_BAR)
rx_reor_tbl_ptr->start_win = seq_num;
mlan_11n_rxreorder_timer_restart(pmadapter,
rx_reor_tbl_ptr);
}
prev_start_win = start_win = rx_reor_tbl_ptr->start_win;
win_size = rx_reor_tbl_ptr->win_size;
end_win = ((start_win + win_size) - 1) & (MAX_TID_VALUE - 1);
PRINTM(MDAT_D, "TID %d, TA " MACSTR "\n", tid, MAC2STR(ta));
PRINTM(MDAT_D,
"1:seq_num %d start_win %d win_size %d end_win %d\n",
seq_num, start_win, win_size, end_win);
/*
* If seq_num is less then starting win then ignore and drop
* the packet
*/
if (rx_reor_tbl_ptr->force_no_drop) {
PRINTM(MDAT_D, "No drop packet\n");
rx_reor_tbl_ptr->force_no_drop = MFALSE;
} else {
/* Wrap */
if ((start_win + TWOPOW11) > (MAX_TID_VALUE - 1)) {
if (seq_num >= ((start_win + (TWOPOW11)) &
(MAX_TID_VALUE - 1)) &&
(seq_num < start_win)) {
if (pkt_type == PKT_TYPE_BAR)
PRINTM(MDAT_D,
"BAR: start_win=%d, end_win=%d, seq_num=%d\n",
start_win, end_win,
seq_num);
ret = MLAN_STATUS_FAILURE;
goto done;
}
} else if ((seq_num < start_win) ||
(seq_num >= (start_win + (TWOPOW11)))) {
if (pkt_type == PKT_TYPE_BAR)
PRINTM(MDAT_D,
"BAR: start_win=%d, end_win=%d, seq_num=%d\n",
start_win, end_win, seq_num);
ret = MLAN_STATUS_FAILURE;
goto done;
}
}
/*
* If this packet is a BAR we adjust seq_num as
* WinStart = seq_num
*/
if (pkt_type == PKT_TYPE_BAR)
seq_num = ((seq_num + win_size) - 1) &
(MAX_TID_VALUE - 1);
PRINTM(MDAT_D,
"2:seq_num %d start_win %d win_size %d end_win %d\n",
seq_num, start_win, win_size, end_win);
if (((end_win < start_win) && (seq_num < start_win) &&
(seq_num > end_win)) ||
((end_win > start_win) &&
((seq_num > end_win) || (seq_num < start_win)))) {
end_win = seq_num;
if (((seq_num - win_size) + 1) >= 0)
start_win = (end_win - win_size) + 1;
else
start_win =
(MAX_TID_VALUE - (win_size - seq_num)) +
1;
ret = wlan_11n_dispatch_pkt_until_start_win(
priv, rx_reor_tbl_ptr, start_win);
if (ret)
goto done;
}
PRINTM(MDAT_D,
"3:seq_num %d start_win %d win_size %d"
" end_win %d\n",
seq_num, start_win, win_size, end_win);
if (pkt_type != PKT_TYPE_BAR) {
if (seq_num >= start_win) {
if (rx_reor_tbl_ptr->rx_reorder_ptr[seq_num -
start_win]) {
PRINTM(MDAT_D, "Drop Duplicate Pkt\n");
ret = MLAN_STATUS_FAILURE;
goto done;
}
rx_reor_tbl_ptr
->rx_reorder_ptr[seq_num - start_win] =
payload;
MLAN_SET_BIT(rx_reor_tbl_ptr->bitmap,
seq_num - start_win);
} else { /* Wrap condition */
if (rx_reor_tbl_ptr
->rx_reorder_ptr[(seq_num +
(MAX_TID_VALUE)) -
start_win]) {
PRINTM(MDAT_D, "Drop Duplicate Pkt\n");
ret = MLAN_STATUS_FAILURE;
goto done;
}
rx_reor_tbl_ptr
->rx_reorder_ptr[(seq_num +
(MAX_TID_VALUE)) -
start_win] = payload;
MLAN_SET_BIT(rx_reor_tbl_ptr->bitmap,
(seq_num + (MAX_TID_VALUE)) -
start_win);
}
}
wlan_11n_display_tbl_ptr(pmadapter, rx_reor_tbl_ptr);
/*
* Dispatch all packets sequentially from start_win until a
* hole is found and adjust the start_win appropriately
*/
ret = wlan_11n_scan_and_dispatch(priv, rx_reor_tbl_ptr);
wlan_11n_display_tbl_ptr(pmadapter, rx_reor_tbl_ptr);
}
done:
if (rx_reor_tbl_ptr->bitmap == 0) {
if (rx_reor_tbl_ptr->timer_context.timer_is_set) {
pmadapter->callbacks.moal_stop_timer(
pmadapter->pmoal_handle,
rx_reor_tbl_ptr->timer_context.timer);
rx_reor_tbl_ptr->timer_context.timer_is_set = MFALSE;
}
} else {
if (!rx_reor_tbl_ptr->timer_context.timer_is_set ||
(prev_start_win != rx_reor_tbl_ptr->start_win)) {
mlan_11n_rxreorder_timer_restart(pmadapter,
rx_reor_tbl_ptr);
}
}
LEAVE();
return ret;
}
/**
* @brief This function will delete an entry for a given tid/ta pair. tid/ta
* are taken from delba_event body
*
* @param priv A pointer to mlan_private
* @param tid tid to send delba
* @param peer_mac MAC address to send delba
* @param type TYPE_DELBA_SENT or TYPE_DELBA_RECEIVE
* @param initiator MTRUE if we are initiator of ADDBA, MFALSE otherwise
* @param reason_code delete ba reason
*
* @return N/A
*/
void mlan_11n_delete_bastream_tbl(mlan_private *priv, int tid, t_u8 *peer_mac,
t_u8 type, int initiator, t_u16 reason_code)
{
RxReorderTbl *rx_reor_tbl_ptr;
TxBAStreamTbl *ptxtbl;
t_u8 cleanup_rx_reorder_tbl;
raListTbl *ra_list = MNULL;
int tid_down;
ENTER();
if (type == TYPE_DELBA_RECEIVE)
cleanup_rx_reorder_tbl = (initiator) ? MTRUE : MFALSE;
else
cleanup_rx_reorder_tbl = (initiator) ? MFALSE : MTRUE;
PRINTM(MEVENT,
"delete_bastream_tbl: " MACSTR " tid=%d, type=%d "
"initiator=%d reason=%d\n",
MAC2STR(peer_mac), tid, type, initiator, reason_code);
if (cleanup_rx_reorder_tbl) {
rx_reor_tbl_ptr =
wlan_11n_get_rxreorder_tbl(priv, tid, peer_mac);
if (!rx_reor_tbl_ptr) {
PRINTM(MWARN, "TID, TA not found in table!\n");
LEAVE();
return;
}
wlan_11n_delete_rxreorder_tbl_entry(priv, rx_reor_tbl_ptr);
} else {
wlan_request_ralist_lock(priv);
ptxtbl = wlan_11n_get_txbastream_tbl(priv, tid, peer_mac,
MFALSE);
if (!ptxtbl) {
PRINTM(MWARN, "TID, RA not found in table!\n");
wlan_release_ralist_lock(priv);
LEAVE();
return;
}
wlan_11n_delete_txbastream_tbl_entry(priv, ptxtbl);
wlan_release_ralist_lock(priv);
tid_down = wlan_get_wmm_tid_down(priv, tid);
ra_list = wlan_wmm_get_ralist_node(priv, tid_down, peer_mac);
if (ra_list) {
ra_list->amsdu_in_ampdu = MFALSE;
ra_list->ba_status = BA_STREAM_NOT_SETUP;
if (type == TYPE_DELBA_RECEIVE) {
if (reason_code == REASON_CODE_STA_TIMEOUT)
ra_list->del_ba_count = 0;
else
ra_list->del_ba_count++;
}
ra_list->packet_count = 0;
/** after delba, we will try to set up BA again after sending 1k packets*/
#define MIN_BA_SETUP_PACKET_REQIRED 1024
ra_list->ba_packet_threshold =
MIN_BA_SETUP_PACKET_REQIRED +
wlan_get_random_ba_threshold(priv->adapter);
}
}
LEAVE();
}
/**
* @brief This function handles the command response of
* a block ack response
*
* @param priv A pointer to mlan_private structure
* @param resp A pointer to HostCmd_DS_COMMAND
*
* @return MLAN_STATUS_SUCCESS
*/
mlan_status wlan_ret_11n_addba_resp(mlan_private *priv,
HostCmd_DS_COMMAND *resp)
{
HostCmd_DS_11N_ADDBA_RSP *padd_ba_rsp =
(HostCmd_DS_11N_ADDBA_RSP *)&resp->params.add_ba_rsp;
int tid;
RxReorderTbl *rx_reor_tbl_ptr = MNULL;
ENTER();
padd_ba_rsp->status_code = wlan_le16_to_cpu(padd_ba_rsp->status_code);
padd_ba_rsp->block_ack_param_set =
wlan_le16_to_cpu(padd_ba_rsp->block_ack_param_set);
padd_ba_rsp->block_ack_tmo =
wlan_le16_to_cpu(padd_ba_rsp->block_ack_tmo);
padd_ba_rsp->ssn = wlan_le16_to_cpu(padd_ba_rsp->ssn);
tid = (padd_ba_rsp->block_ack_param_set & BLOCKACKPARAM_TID_MASK) >>
BLOCKACKPARAM_TID_POS;
/* Check if we had rejected the ADDBA, if yes then do not create the
* stream
*/
if (padd_ba_rsp->status_code == BA_RESULT_SUCCESS) {
PRINTM(MCMND,
"ADDBA RSP: " MACSTR
" tid=%d ssn=%d win_size=%d,amsdu=%d\n",
MAC2STR(padd_ba_rsp->peer_mac_addr), tid,
padd_ba_rsp->ssn,
((padd_ba_rsp->block_ack_param_set &
BLOCKACKPARAM_WINSIZE_MASK) >>
BLOCKACKPARAM_WINSIZE_POS),
padd_ba_rsp->block_ack_param_set &
BLOCKACKPARAM_AMSDU_SUPP_MASK);
rx_reor_tbl_ptr = wlan_11n_get_rxreorder_tbl(
priv, tid, padd_ba_rsp->peer_mac_addr);
if (rx_reor_tbl_ptr) {
rx_reor_tbl_ptr->ba_status = BA_STREAM_SETUP_COMPLETE;
if ((padd_ba_rsp->block_ack_param_set &
BLOCKACKPARAM_AMSDU_SUPP_MASK) &&
priv->add_ba_param.rx_amsdu)
rx_reor_tbl_ptr->amsdu = MTRUE;
else
rx_reor_tbl_ptr->amsdu = MFALSE;
}
} else {
PRINTM(MCMND, "ADDBA RSP: Failed(" MACSTR " tid=%d)\n",
MAC2STR(padd_ba_rsp->peer_mac_addr), tid);
rx_reor_tbl_ptr = wlan_11n_get_rxreorder_tbl(
priv, tid, padd_ba_rsp->peer_mac_addr);
if (rx_reor_tbl_ptr)
wlan_11n_delete_rxreorder_tbl_entry(priv,
rx_reor_tbl_ptr);
}
LEAVE();
return MLAN_STATUS_SUCCESS;
}
/**
* @brief This function handles ba_stream_timeout event
*
* @param priv A pointer to mlan_private
* @param event A pointer to structure HostCmd_DS_11N_BATIMEOUT
*
* @return N/A
*/
void wlan_11n_ba_stream_timeout(mlan_private *priv,
HostCmd_DS_11N_BATIMEOUT *event)
{
HostCmd_DS_11N_DELBA delba;
mlan_status ret = MLAN_STATUS_SUCCESS;
ENTER();
DBG_HEXDUMP(MCMD_D, "Event:", (t_u8 *)event, 20);
if (event->origninator &&
!wlan_11n_get_txbastream_tbl(priv, event->tid, event->peer_mac_addr,
MFALSE)) {
LEAVE();
return;
}
memset(priv->adapter, &delba, 0, sizeof(HostCmd_DS_11N_DELBA));
memcpy_ext(priv->adapter, delba.peer_mac_addr, event->peer_mac_addr,
MLAN_MAC_ADDR_LENGTH, MLAN_MAC_ADDR_LENGTH);
delba.del_ba_param_set |= (t_u16)event->tid << DELBA_TID_POS;
delba.del_ba_param_set |= (t_u16)event->origninator
<< DELBA_INITIATOR_POS;
delba.reason_code = REASON_CODE_STA_TIMEOUT;
ret = wlan_prepare_cmd(priv, HostCmd_CMD_11N_DELBA, 0, 0, MNULL,
&delba);
if (ret)
PRINTM(MERROR, "Failed to send cmd to FW\n");
LEAVE();
return;
}
/**
* @brief This function cleans up reorder tbl
*
* @param priv A pointer to mlan_private
*
* @return N/A
*/
void wlan_11n_cleanup_reorder_tbl(mlan_private *priv)
{
RxReorderTbl *del_tbl_ptr;
ENTER();
while ((del_tbl_ptr = (RxReorderTbl *)util_peek_list(
priv->adapter->pmoal_handle, &priv->rx_reorder_tbl_ptr,
priv->adapter->callbacks.moal_spin_lock,
priv->adapter->callbacks.moal_spin_unlock))) {
wlan_11n_delete_rxreorder_tbl_entry(priv, del_tbl_ptr);
}
util_init_list((pmlan_linked_list)&priv->rx_reorder_tbl_ptr);
memset(priv->adapter, priv->rx_seq, 0xff, sizeof(priv->rx_seq));
LEAVE();
}
/**
* @brief This function handle the rxba_sync event
*
* @param priv A pointer to mlan_private
* @param event_buf A pointer to event buf
* @param len event_buf length
* @return N/A
*/
void wlan_11n_rxba_sync_event(mlan_private *priv, t_u8 *event_buf, t_u16 len)
{
MrvlIEtypes_RxBaSync_t *tlv_rxba = (MrvlIEtypes_RxBaSync_t *)event_buf;
t_u16 tlv_type, tlv_len;
RxReorderTbl *rx_reor_tbl_ptr = MNULL;
t_u8 i, j;
t_u16 seq_num = 0;
int tlv_buf_left = len;
ENTER();
DBG_HEXDUMP(MEVT_D, "RXBA_SYNC_EVT", event_buf, len);
while (tlv_buf_left >= (int)sizeof(MrvlIEtypes_RxBaSync_t)) {
tlv_type = wlan_le16_to_cpu(tlv_rxba->header.type);
tlv_len = wlan_le16_to_cpu(tlv_rxba->header.len);
if (tlv_type != TLV_TYPE_RXBA_SYNC) {
PRINTM(MERROR, "Wrong TLV id=0x%x\n", tlv_type);
goto done;
}
tlv_rxba->seq_num = wlan_le16_to_cpu(tlv_rxba->seq_num);
tlv_rxba->bitmap_len = wlan_le16_to_cpu(tlv_rxba->bitmap_len);
PRINTM(MEVENT, MACSTR " tid=%d seq_num=%d bitmap_len=%d\n",
MAC2STR(tlv_rxba->mac), tlv_rxba->tid, tlv_rxba->seq_num,
tlv_rxba->bitmap_len);
rx_reor_tbl_ptr = wlan_11n_get_rxreorder_tbl(
priv, tlv_rxba->tid, tlv_rxba->mac);
if (!rx_reor_tbl_ptr) {
PRINTM(MEVENT, "Can not find rx_reorder_tbl\n");
goto done;
}
if (rx_reor_tbl_ptr->force_no_drop) {
PRINTM(MEVENT, "Ignore RXBA_SYNC_EVT in resume\n");
goto done;
}
for (i = 0; i < tlv_rxba->bitmap_len; i++) {
for (j = 0; j < 8; j++) {
if (tlv_rxba->bitmap[i] & (1 << j)) {
seq_num = (tlv_rxba->seq_num + i * 8 +
j) &
(MAX_TID_VALUE - 1);
PRINTM(MEVENT,
"Fw dropped packet, seq=%d start_win=%d, win_size=%d\n",
seq_num,
rx_reor_tbl_ptr->start_win,
rx_reor_tbl_ptr->win_size);
if (MLAN_STATUS_SUCCESS !=
mlan_11n_rxreorder_pkt(
priv, seq_num,
tlv_rxba->tid,
tlv_rxba->mac, 0,
(t_void *)
RX_PKT_DROPPED_IN_FW)) {
PRINTM(MERROR,
"Fail to handle dropped packet, seq=%d\n",
seq_num);
}
}
}
}
tlv_buf_left -= (sizeof(MrvlIEtypesHeader_t) + tlv_len);
tlv_rxba =
(MrvlIEtypes_RxBaSync_t *)((t_u8 *)tlv_rxba + tlv_len +
sizeof(MrvlIEtypesHeader_t));
}
done:
LEAVE();
return;
}
/**
* @brief This function cleans up reorder tbl for specific station
*
* @param priv A pointer to mlan_private
* @param ta ta to find in reordering table
* @return N/A
*/
void wlan_cleanup_reorder_tbl(mlan_private *priv, t_u8 *ta)
{
RxReorderTbl *rx_reor_tbl_ptr = MNULL;
t_u8 i;
ENTER();
for (i = 0; i < MAX_NUM_TID; ++i) {
rx_reor_tbl_ptr = wlan_11n_get_rxreorder_tbl(priv, i, ta);
if (rx_reor_tbl_ptr)
wlan_11n_delete_rxreorder_tbl_entry(priv,
rx_reor_tbl_ptr);
}
LEAVE();
return;
}
/**
* @brief This function will set force_no_drop flag in rxreorder_tbl.
*
* @param priv A pointer to mlan_private
* @param flag MTRUE/MFALSE
*
* @return N/A
*/
static void wlan_set_rxreorder_tbl_no_drop_flag(mlan_private *priv, t_u8 flag)
{
RxReorderTbl *rx_reor_tbl_ptr;
ENTER();
rx_reor_tbl_ptr = (RxReorderTbl *)util_peek_list(
priv->adapter->pmoal_handle, &priv->rx_reorder_tbl_ptr,
priv->adapter->callbacks.moal_spin_lock,
priv->adapter->callbacks.moal_spin_unlock);
if (!rx_reor_tbl_ptr) {
LEAVE();
return;
}
while (rx_reor_tbl_ptr != (RxReorderTbl *)&priv->rx_reorder_tbl_ptr) {
rx_reor_tbl_ptr->force_no_drop = flag;
rx_reor_tbl_ptr = rx_reor_tbl_ptr->pnext;
}
LEAVE();
return;
}
/**
* @brief This function update all the rx_reorder_tbl's force_no_drop flag
*
* @param pmadapter A pointer to mlan_adapter
* @param flag MTRUE/MFALSE
* @return N/A
*/
void wlan_update_rxreorder_tbl(pmlan_adapter pmadapter, t_u8 flag)
{
t_u8 i;
pmlan_private priv = MNULL;
for (i = 0; i < pmadapter->priv_num; i++) {
if (pmadapter->priv[i]) {
priv = pmadapter->priv[i];
wlan_set_rxreorder_tbl_no_drop_flag(priv, flag);
}
}
return;
}
/**
* @brief This function will flush the data in rxreorder_tbl.
* which has flush_data flag on.
*
* @param priv A pointer to mlan_private
*
* @return N/A
*/
static void wlan_flush_priv_rxreorder_tbl(mlan_private *priv)
{
RxReorderTbl *rx_reor_tbl_ptr;
ENTER();
rx_reor_tbl_ptr = (RxReorderTbl *)util_peek_list(
priv->adapter->pmoal_handle, &priv->rx_reorder_tbl_ptr,
priv->adapter->callbacks.moal_spin_lock,
priv->adapter->callbacks.moal_spin_unlock);
if (!rx_reor_tbl_ptr) {
LEAVE();
return;
}
while (rx_reor_tbl_ptr != (RxReorderTbl *)&priv->rx_reorder_tbl_ptr) {
if (rx_reor_tbl_ptr->flush_data) {
rx_reor_tbl_ptr->flush_data = MFALSE;
wlan_start_flush_data(priv, rx_reor_tbl_ptr);
}
rx_reor_tbl_ptr = rx_reor_tbl_ptr->pnext;
}
LEAVE();
return;
}
/**
* @brief This function update all the rx_reorder_tbl's force_no_drop flag
*
* @param pmadapter A pointer to mlan_adapter
* @return N/A
*/
void wlan_flush_rxreorder_tbl(pmlan_adapter pmadapter)
{
t_u8 i;
pmlan_private priv = MNULL;
for (i = 0; i < pmadapter->priv_num; i++) {
if (pmadapter->priv[i]) {
priv = pmadapter->priv[i];
wlan_flush_priv_rxreorder_tbl(priv);
}
}
return;
}
/**
* @brief This function update all the rx_win_size based on coex flag
*
* @param pmadapter A pointer to mlan_adapter
* @param coex_flag coex flag
*
* @return N/A
*/
static void wlan_update_ampdu_rxwinsize(pmlan_adapter pmadapter, t_u8 coex_flag)
{
t_u8 i;
t_u8 j;
t_u32 rx_win_size = 0;
pmlan_private priv = MNULL;
ENTER();
if (!pmadapter->coex_rx_winsize) {
LEAVE();
return;
}
PRINTM(MEVENT, "Update rxwinsize %d\n", coex_flag);
for (i = 0; i < pmadapter->priv_num; i++) {
if (pmadapter->priv[i]) {
priv = pmadapter->priv[i];
rx_win_size = priv->add_ba_param.rx_win_size;
if (coex_flag == MTRUE) {
#ifdef STA_SUPPORT
if (priv->bss_type == MLAN_BSS_TYPE_STA)
priv->add_ba_param.rx_win_size =
MLAN_STA_COEX_AMPDU_DEF_RXWINSIZE;
#endif
#ifdef WIFI_DIRECT_SUPPORT
if (priv->bss_type == MLAN_BSS_TYPE_WIFIDIRECT)
priv->add_ba_param.rx_win_size =
MLAN_WFD_COEX_AMPDU_DEF_RXWINSIZE;
#endif
if (priv->bss_type == MLAN_BSS_TYPE_NAN)
priv->add_ba_param.rx_win_size =
MLAN_NAN_COEX_AMPDU_DEF_RXWINSIZE;
#ifdef UAP_SUPPORT
if (priv->bss_type == MLAN_BSS_TYPE_UAP)
priv->add_ba_param.rx_win_size =
MLAN_UAP_COEX_AMPDU_DEF_RXWINSIZE;
#endif
priv->add_ba_param.rx_win_size =
MIN(priv->add_ba_param.rx_win_size,
priv->user_rxwinsize);
} else {
priv->add_ba_param.rx_win_size =
priv->user_rxwinsize;
}
if (pmadapter->coex_win_size &&
pmadapter->coex_rx_win_size)
priv->add_ba_param.rx_win_size =
pmadapter->coex_rx_win_size;
if (rx_win_size != priv->add_ba_param.rx_win_size) {
if (priv->media_connected == MTRUE) {
for (j = 0; j < MAX_NUM_TID; j++)
wlan_11n_delba(priv, j);
wlan_recv_event(
priv,
MLAN_EVENT_ID_DRV_DEFER_HANDLING,
MNULL);
}
}
}
}
LEAVE();
return;
}
/**
* @brief check coex for
*
* @param pmadapter A pointer to mlan_adapter
*
* @return N/A
*/
void wlan_coex_ampdu_rxwinsize(pmlan_adapter pmadapter)
{
t_u8 i;
pmlan_private priv = MNULL;
t_u8 count = 0;
for (i = 0; i < pmadapter->priv_num; i++) {
if (pmadapter->priv[i]) {
priv = pmadapter->priv[i];
#ifdef STA_SUPPORT
if (GET_BSS_ROLE((mlan_private *)priv) ==
MLAN_BSS_ROLE_STA) {
if (priv->media_connected == MTRUE)
count++;
}
#endif
#ifdef UAP_SUPPORT
if (GET_BSS_ROLE((mlan_private *)priv) ==
MLAN_BSS_ROLE_UAP) {
if (priv->uap_bss_started)
count++;
}
#endif
}
if (count >= 2)
break;
}
if (count >= 2)
wlan_update_ampdu_rxwinsize(pmadapter, MTRUE);
else
wlan_update_ampdu_rxwinsize(pmadapter, MFALSE);
return;
}
Reference in a new issue View git blame Copy permalink