static t_void
wlan_flush_data(t_void * context)
{
reorder_tmr_cnxt_t *reorder_cnxt = (reorder_tmr_cnxt_t *) context;
int startWin;
reorder_cnxt->timer_is_set = MFALSE;
wlan_11n_display_tbl_ptr(reorder_cnxt->priv->adapter, reorder_cnxt->ptr);
if ((startWin = wlan_11n_find_last_seqnum(reorder_cnxt->ptr)) >= 0) {
PRINTM(MINFO, "Flush data %d\n", startWin);
wlan_11n_dispatch_pkt_until_start_win(reorder_cnxt->priv,
reorder_cnxt->ptr,
((reorder_cnxt->ptr->start_win +
startWin + 1) % MAX_TID_VALUE));
}
wlan_11n_display_tbl_ptr(reorder_cnxt->priv->adapter, reorder_cnxt->ptr);
}
/**
* @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;
}
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);
priv->adapter->callbacks.moal_free_timer(pmadapter->pmoal_handle,
rx_reor_tbl_ptr->timer_context.
timer);
}
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);
LEAVE();
}
/**
* @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();
}
