/** * @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; }