/**
* @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
*
* @return N/A
*/
void
mlan_11n_delete_bastream_tbl(mlan_private * priv, int tid,
t_u8 * peer_mac, t_u8 type, int initiator)
{
RxReorderTbl *rx_reor_tbl_ptr;
TxBAStreamTbl *ptxtbl;
t_u8 cleanup_rx_reorder_tbl;
ENTER();
if (type == TYPE_DELBA_RECEIVE)
cleanup_rx_reorder_tbl = (initiator) ? MTRUE : MFALSE;
else
cleanup_rx_reorder_tbl = (initiator) ? MFALSE : MTRUE;
PRINTM(MEVENT, "DELBA: %02x:%02x:%02x:%02x:%02x:%02x tid=%d,"
"initiator=%d\n", peer_mac[0],
peer_mac[1], peer_mac[2],
peer_mac[3], peer_mac[4], peer_mac[5], tid, initiator);
if (cleanup_rx_reorder_tbl) {
if (!(rx_reor_tbl_ptr = wlan_11n_get_rxreorder_tbl(priv, tid,
peer_mac))) {
PRINTM(MERROR, "TID,TA not found in table!\n");
LEAVE();
return;
}
wlan_11n_delete_rxreorder_tbl_entry(priv, rx_reor_tbl_ptr);
} else {
if (!(ptxtbl = wlan_11n_get_txbastream_tbl(priv, tid, peer_mac))) {
PRINTM(MERROR, "TID,RA not found in table!\n");
LEAVE();
return;
}
wlan_11n_delete_txbastream_tbl_entry(priv, ptxtbl);
}
LEAVE();
}
/**
* @brief This function processes received packet and forwards it
* to kernel/upper layer
*
* @param adapter A pointer to mlan_adapter
* @param pmbuf A pointer to mlan_buffer which includes the received packet
*
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
*/
mlan_status
wlan_ops_uap_process_rx_packet(IN t_void *adapter, IN pmlan_buffer pmbuf)
{
pmlan_adapter pmadapter = (pmlan_adapter)adapter;
mlan_status ret = MLAN_STATUS_SUCCESS;
UapRxPD *prx_pd;
wlan_mgmt_pkt *puap_pkt_hdr = MNULL;
RxPacketHdr_t *prx_pkt;
pmlan_private priv = pmadapter->priv[pmbuf->bss_index];
t_u8 ta[MLAN_MAC_ADDR_LENGTH];
t_u16 rx_pkt_type = 0;
sta_node *sta_ptr = MNULL;
t_u8 adj_rx_rate = 0;
ENTER();
prx_pd = (UapRxPD *)(pmbuf->pbuf + pmbuf->data_offset);
/* Endian conversion */
uap_endian_convert_RxPD(prx_pd);
priv->rxpd_rate = prx_pd->rx_rate;
priv->rxpd_rate_info = prx_pd->rate_info;
if (!priv->adapter->psdio_device->v15_fw_api)
priv->rxpd_rate_info =
wlan_convert_v14_rate_ht_info(priv->rxpd_rate_info);
if (priv->bss_type == MLAN_BSS_TYPE_UAP) {
adj_rx_rate =
wlan_adjust_data_rate(priv, priv->rxpd_rate,
priv->rxpd_rate_info);
pmadapter->callbacks.moal_hist_data_add(pmadapter->pmoal_handle,
pmbuf->bss_index,
adj_rx_rate,
prx_pd->snr, prx_pd->nf,
prx_pd->antenna);
}
rx_pkt_type = prx_pd->rx_pkt_type;
prx_pkt = (RxPacketHdr_t *)((t_u8 *)prx_pd + prx_pd->rx_pkt_offset);
PRINTM(MINFO,
"RX Data: data_len - prx_pd->rx_pkt_offset = %d - %d = %d\n",
pmbuf->data_len, prx_pd->rx_pkt_offset,
pmbuf->data_len - prx_pd->rx_pkt_offset);
if ((prx_pd->rx_pkt_offset + prx_pd->rx_pkt_length) !=
(t_u16)pmbuf->data_len) {
PRINTM(MERROR,
"Wrong rx packet: len=%d,rx_pkt_offset=%d,"
" rx_pkt_length=%d\n", pmbuf->data_len,
prx_pd->rx_pkt_offset, prx_pd->rx_pkt_length);
pmbuf->status_code = MLAN_ERROR_PKT_SIZE_INVALID;
ret = MLAN_STATUS_FAILURE;
wlan_free_mlan_buffer(pmadapter, pmbuf);
goto done;
}
pmbuf->data_len = prx_pd->rx_pkt_offset + prx_pd->rx_pkt_length;
if (pmadapter->priv[pmbuf->bss_index]->mgmt_frame_passthru_mask &&
prx_pd->rx_pkt_type == PKT_TYPE_MGMT_FRAME) {
/* Check if this is mgmt packet and needs to forwarded to app
as an event */
puap_pkt_hdr =
(wlan_mgmt_pkt *)((t_u8 *)prx_pd +
prx_pd->rx_pkt_offset);
puap_pkt_hdr->frm_len = wlan_le16_to_cpu(puap_pkt_hdr->frm_len);
if ((puap_pkt_hdr->wlan_header.
frm_ctl & IEEE80211_FC_MGMT_FRAME_TYPE_MASK) == 0)
wlan_process_802dot11_mgmt_pkt(pmadapter->
priv[pmbuf->bss_index],
(t_u8 *)&puap_pkt_hdr->
wlan_header,
puap_pkt_hdr->frm_len +
sizeof(wlan_mgmt_pkt) -
sizeof(puap_pkt_hdr->
frm_len),
(RxPD *)prx_pd);
wlan_free_mlan_buffer(pmadapter, pmbuf);
goto done;
}
pmbuf->priority = prx_pd->priority;
memcpy(pmadapter, ta, prx_pkt->eth803_hdr.src_addr,
MLAN_MAC_ADDR_LENGTH);
if ((rx_pkt_type != PKT_TYPE_BAR) && (prx_pd->priority < MAX_NUM_TID)) {
sta_ptr = wlan_get_station_entry(priv, ta);
if (sta_ptr)
sta_ptr->rx_seq[prx_pd->priority] = prx_pd->seq_num;
}
/* check if UAP enable 11n */
if (!priv->is_11n_enabled ||
(!wlan_11n_get_rxreorder_tbl
((mlan_private *)priv, prx_pd->priority, ta)
&& (prx_pd->rx_pkt_type != PKT_TYPE_AMSDU)
)) {
if (priv->pkt_fwd)
wlan_process_uap_rx_packet(priv, pmbuf);
else
wlan_upload_uap_rx_packet(pmadapter, pmbuf);
goto done;
}
/* Reorder and send to OS */
ret = mlan_11n_rxreorder_pkt(priv, prx_pd->seq_num,
prx_pd->priority, ta,
(t_u8)prx_pd->rx_pkt_type, (void *)pmbuf);
if (ret || (rx_pkt_type == PKT_TYPE_BAR)) {
wlan_free_mlan_buffer(pmadapter, pmbuf);
}
done:
LEAVE();
return ret;
}
/**
* @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 start_win, end_win, win_size;
mlan_status ret = MLAN_STATUS_SUCCESS;
pmlan_adapter pmadapter = ((mlan_private *) priv)->adapter;
ENTER();
if (!
(rx_reor_tbl_ptr =
wlan_11n_get_rxreorder_tbl((mlan_private *) priv, tid, ta))) {
LEAVE();
if (pkt_type == PKT_TYPE_BAR)
return ret;
else {
wlan_11n_dispatch_pkt(priv, payload);
return ret;
}
} else {
if (pkt_type == PKT_TYPE_BAR)
PRINTM(MDAT_D, "BAR ");
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);
if (rx_reor_tbl_ptr->timer_context.timer_is_set)
pmadapter->callbacks.moal_stop_timer(rx_reor_tbl_ptr->timer_context.
timer);
pmadapter->callbacks.moal_start_timer(rx_reor_tbl_ptr->timer_context.
timer, MFALSE,
MIN_FLUSH_TIMER_MS * win_size);
rx_reor_tbl_ptr->timer_context.timer_is_set = MTRUE;
PRINTM(MDAT_D, "TID %d, TA %02x:%02x:%02x:%02x:%02x:%02x\n",
tid, ta[0], ta[1], ta[2], ta[3], ta[4], ta[5]);
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 ((start_win + TWOPOW11) > (MAX_TID_VALUE - 1)) { /* Wrap */
if (seq_num >= ((start_win + (TWOPOW11)) &
~(MAX_TID_VALUE)) && (seq_num < start_win)) {
LEAVE();
return MLAN_STATUS_FAILURE;
}
} else if ((seq_num < start_win) ||
(seq_num > (start_win + (TWOPOW11)))) {
LEAVE();
return MLAN_STATUS_FAILURE;
}
/*
* 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);
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 < (TWOPOW11 -
(MAX_TID_VALUE - 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;
if ((ret = wlan_11n_dispatch_pkt_until_start_win(priv,
rx_reor_tbl_ptr,
start_win))) {
LEAVE();
return ret;
}
}
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)
rx_reor_tbl_ptr->rx_reorder_ptr[seq_num - start_win] = payload;
else /* Wrap condition */
rx_reor_tbl_ptr->rx_reorder_ptr[(seq_num
+ (MAX_TID_VALUE)) -
start_win] = payload;
}
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);
}
LEAVE();
return ret;
}
/**
* @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
*/
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;
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
*/
if ((rx_reor_tbl_ptr = wlan_11n_get_rxreorder_tbl(priv, tid, ta))) {
wlan_11n_dispatch_pkt_until_start_win(priv, rx_reor_tbl_ptr, seq_num);
} else {
PRINTM(MDAT_D, "%s: seq_num %d, tid %d, ta %02x:%02x:%02x:%02x:"
"%02x:%02x, win_size %d\n", __FUNCTION__,
seq_num, tid, ta[0], ta[1], ta[2], ta[3],
ta[4], ta[5], win_size);
if (pmadapter->callbacks.moal_malloc(sizeof(RxReorderTbl),
(t_u8 **) & new_node)) {
PRINTM(MERROR, "Rx reorder memory allocation failed\n");
return;
}
util_init_list((pmlan_linked_list) new_node);
new_node->tid = tid;
memcpy(new_node->ta, ta, MLAN_MAC_ADDR_LENGTH);
new_node->start_win = seq_num;
new_node->win_size = win_size;
if (pmadapter->callbacks.moal_malloc(sizeof(t_void *) * win_size,
(t_u8 **) & new_node->
rx_reorder_ptr)) {
PRINTM(MERROR, "Rx reorder table memory allocation" "failed\n");
pmadapter->callbacks.moal_mfree((t_u8 *) new_node);
return;
}
PRINTM(MDAT_D, "Create ReorderPtr: %p\n", new_node);
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(&new_node->timer_context.
timer, wlan_flush_data,
&new_node->timer_context);
for (i = 0; i < win_size; ++i)
new_node->rx_reorder_ptr[i] = MNULL;
util_enqueue_list_tail(&priv->rx_reorder_tbl_ptr,
(pmlan_linked_list) new_node,
pmadapter->callbacks.moal_spin_lock,
pmadapter->callbacks.moal_spin_unlock);
}
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
*/
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;
#ifdef UAP_SUPPORT
sta_node *sta_ptr = MNULL;
#endif
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
*/
if ((rx_reor_tbl_ptr = wlan_11n_get_rxreorder_tbl(priv, tid, ta))) {
wlan_11n_dispatch_pkt_until_start_win(priv, rx_reor_tbl_ptr, seq_num);
} else {
PRINTM(MDAT_D, "%s: seq_num %d, tid %d, ta %02x:%02x:%02x:%02x:"
"%02x:%02x, win_size %d\n", __FUNCTION__,
seq_num, tid, ta[0], ta[1], ta[2], ta[3],
ta[4], ta[5], 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");
return;
}
util_init_list((pmlan_linked_list) new_node);
new_node->tid = tid;
memcpy(pmadapter, new_node->ta, ta, MLAN_MAC_ADDR_LENGTH);
new_node->start_win = seq_num;
if (queuing_ra_based(priv)) {
// TODO for adhoc
#ifdef UAP_SUPPORT
if (GET_BSS_ROLE(priv) == MLAN_BSS_ROLE_UAP) {
if ((sta_ptr = wlan_get_station_entry(priv, ta)))
last_seq = sta_ptr->rx_seq[tid];
}
#endif
PRINTM(MINFO, "UAP/ADHOC:last_seq=%d start_win=%d\n", last_seq,
new_node->start_win);
} else {
last_seq = priv->rx_seq[tid];
}
if (last_seq >= new_node->start_win) {
PRINTM(MDAT_D, "Update start_win: last_seq=%d, start_win=%d\n",
last_seq, new_node->start_win);
new_node->start_win = last_seq + 1;
}
new_node->win_size = win_size;
if (pmadapter->callbacks.
moal_malloc(pmadapter->pmoal_handle, sizeof(t_void *) * 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);
return;
}
PRINTM(MDAT_D, "Create ReorderPtr: %p\n", new_node);
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);
for (i = 0; i < win_size; ++i)
new_node->rx_reorder_ptr[i] = MNULL;
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);
}
LEAVE();
}
/**
* @brief This function processes received packet and forwards it
* to kernel/upper layer
*
* @param adapter A pointer to mlan_adapter
* @param pmbuf A pointer to mlan_buffer which includes the received packet
*
* @return MLAN_STATUS_SUCCESS or MLAN_STATUS_FAILURE
*/
mlan_status
wlan_ops_uap_process_rx_packet(IN t_void * adapter, IN pmlan_buffer pmbuf)
{
pmlan_adapter pmadapter = (pmlan_adapter) adapter;
mlan_status ret = MLAN_STATUS_SUCCESS;
UapRxPD *prx_pd;
wlan_mgmt_pkt *puap_pkt_hdr = MNULL;
RxPacketHdr_t *prx_pkt;
pmlan_private priv = pmadapter->priv[pmbuf->bss_index];
t_u8 ta[MLAN_MAC_ADDR_LENGTH];
t_u16 rx_pkt_type = 0;
sta_node *sta_ptr = MNULL;
ENTER();
prx_pd = (UapRxPD *) (pmbuf->pbuf + pmbuf->data_offset);
/* Endian conversion */
uap_endian_convert_RxPD(prx_pd);
rx_pkt_type = prx_pd->rx_pkt_type;
prx_pkt = (RxPacketHdr_t *) ((t_u8 *) prx_pd + prx_pd->rx_pkt_offset);
PRINTM(MINFO, "RX Data: data_len - prx_pd->rx_pkt_offset = %d - %d = %d\n",
pmbuf->data_len, prx_pd->rx_pkt_offset,
pmbuf->data_len - prx_pd->rx_pkt_offset);
if ((prx_pd->rx_pkt_offset + prx_pd->rx_pkt_length) >
(t_u16) pmbuf->data_len) {
PRINTM(MERROR,
"Wrong rx packet: len=%d,rx_pkt_offset=%d,"
" rx_pkt_length=%d\n", pmbuf->data_len, prx_pd->rx_pkt_offset,
prx_pd->rx_pkt_length);
pmbuf->status_code = MLAN_ERROR_PKT_SIZE_INVALID;
ret = MLAN_STATUS_FAILURE;
pmadapter->callbacks.moal_recv_complete(pmadapter->pmoal_handle,
pmbuf, MLAN_USB_EP_DATA, ret);
goto done;
}
pmbuf->data_len = prx_pd->rx_pkt_offset + prx_pd->rx_pkt_length;
if (pmadapter->priv[pmbuf->bss_index]->mgmt_frame_passthru_mask &&
prx_pd->rx_pkt_type == PKT_TYPE_MGMT_FRAME) {
/* Check if this is mgmt packet and needs to forwarded to app as an
event */
puap_pkt_hdr =
(wlan_mgmt_pkt *) ((t_u8 *) prx_pd + prx_pd->rx_pkt_offset);
puap_pkt_hdr->frm_len = wlan_le16_to_cpu(puap_pkt_hdr->frm_len);
if ((puap_pkt_hdr->wlan_header.
frm_ctl & IEEE80211_FC_MGMT_FRAME_TYPE_MASK) == 0)
wlan_process_802dot11_mgmt_pkt(pmadapter->priv[pmbuf->bss_index],
(t_u8 *) & puap_pkt_hdr->wlan_header,
puap_pkt_hdr->frm_len +
sizeof(wlan_mgmt_pkt) -
sizeof(puap_pkt_hdr->frm_len));
}
pmbuf->priority = prx_pd->priority;
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);
goto done;
}
memcpy(pmadapter, ta, prx_pkt->eth803_hdr.src_addr, MLAN_MAC_ADDR_LENGTH);
if ((rx_pkt_type != PKT_TYPE_BAR) && (prx_pd->priority < MAX_NUM_TID)) {
if ((sta_ptr = wlan_get_station_entry(priv, ta)))
sta_ptr->rx_seq[prx_pd->priority] = prx_pd->seq_num;
}
/* check if UAP enable 11n */
if (!priv->is_11n_enabled ||
!wlan_11n_get_rxreorder_tbl((mlan_private *) priv, prx_pd->priority,
ta)) {
if (priv->pkt_fwd)
wlan_process_uap_rx_packet(priv, pmbuf);
else
wlan_upload_uap_rx_packet(pmadapter, pmbuf);
goto done;
}
/* Reorder and send to OS */
if ((ret = mlan_11n_rxreorder_pkt(priv, prx_pd->seq_num,
prx_pd->priority, ta,
(t_u8) prx_pd->rx_pkt_type,
(void *) pmbuf))
|| (rx_pkt_type == PKT_TYPE_BAR)) {
if ((ret =
pmadapter->callbacks.moal_recv_complete(pmadapter->pmoal_handle,
pmbuf, MLAN_USB_EP_DATA,
ret)))
PRINTM(MERROR, "uAP Rx Error: moal_recv_complete returned error\n");
}
done:
if (priv->is_11n_enabled &&
(pmadapter->pending_bridge_pkts >= RX_MED_THRESHOLD))
wlan_send_delba_to_all_in_reorder_tbl(priv);
LEAVE();
return ret;
}
