770 lines
20 KiB
C
770 lines
20 KiB
C
/******************************************************************************
|
|
*
|
|
* Copyright(c) 2007 - 2012 Realtek Corporation. All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of version 2 of the GNU General Public License as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope that it will be useful, but WITHOUT
|
|
* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
|
|
* more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License along with
|
|
* this program; if not, write to the Free Software Foundation, Inc.,
|
|
* 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
|
|
*
|
|
*
|
|
******************************************************************************/
|
|
#define _RTL8703BS_XMIT_C_
|
|
|
|
#include <rtl8703b_hal.h>
|
|
|
|
static u8 rtw_sdio_wait_enough_TxOQT_space(PADAPTER padapter, u8 agg_num)
|
|
{
|
|
u32 n = 0;
|
|
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
|
|
|
while (pHalData->SdioTxOQTFreeSpace < agg_num)
|
|
{
|
|
if (RTW_CANNOT_RUN(padapter)) {
|
|
DBG_871X("%s: bSurpriseRemoved or bDriverStopped (wait TxOQT)\n", __func__);
|
|
return _FALSE;
|
|
}
|
|
|
|
HalQueryTxOQTBufferStatus8703BSdio(padapter);
|
|
|
|
if ((++n % 60) == 0) {
|
|
if ((n % 300) == 0) {
|
|
DBG_871X("%s(%d): QOT free space(%d), agg_num: %d\n",
|
|
__func__, n, pHalData->SdioTxOQTFreeSpace, agg_num);
|
|
}
|
|
rtw_msleep_os(1);
|
|
//yield();
|
|
}
|
|
}
|
|
|
|
pHalData->SdioTxOQTFreeSpace -= agg_num;
|
|
|
|
//if (n > 1)
|
|
// ++priv->pshare->nr_out_of_txoqt_space;
|
|
|
|
return _TRUE;
|
|
}
|
|
|
|
static s32 rtl8703_dequeue_writeport(PADAPTER padapter)
|
|
{
|
|
struct mlme_priv *pmlmepriv = &padapter->mlmepriv;
|
|
struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
|
|
struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
|
|
struct xmit_buf *pxmitbuf;
|
|
u8 PageIdx = 0;
|
|
u32 deviceId;
|
|
#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT
|
|
u8 bUpdatePageNum = _FALSE;
|
|
#else
|
|
u32 polling_num = 0;
|
|
#endif
|
|
|
|
if (rtw_xmit_ac_blocked(padapter) == _TRUE)
|
|
pxmitbuf = dequeue_pending_xmitbuf_under_survey(pxmitpriv);
|
|
else
|
|
pxmitbuf = dequeue_pending_xmitbuf(pxmitpriv);
|
|
|
|
if (pxmitbuf == NULL)
|
|
return _TRUE;
|
|
|
|
deviceId = ffaddr2deviceId(pdvobjpriv, pxmitbuf->ff_hwaddr);
|
|
|
|
// translate fifo addr to queue index
|
|
switch (deviceId) {
|
|
case WLAN_TX_HIQ_DEVICE_ID:
|
|
PageIdx = HI_QUEUE_IDX;
|
|
break;
|
|
|
|
case WLAN_TX_MIQ_DEVICE_ID:
|
|
PageIdx = MID_QUEUE_IDX;
|
|
break;
|
|
|
|
case WLAN_TX_LOQ_DEVICE_ID:
|
|
PageIdx = LOW_QUEUE_IDX;
|
|
break;
|
|
}
|
|
|
|
query_free_page:
|
|
/* check if hardware tx fifo page is enough */
|
|
if (_FALSE == rtw_hal_sdio_query_tx_freepage(padapter, PageIdx, pxmitbuf->pg_num)) {
|
|
#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT
|
|
if (!bUpdatePageNum) {
|
|
// Total number of page is NOT available, so update current FIFO status
|
|
HalQueryTxBufferStatus8703BSdio(padapter);
|
|
bUpdatePageNum = _TRUE;
|
|
goto query_free_page;
|
|
} else {
|
|
bUpdatePageNum = _FALSE;
|
|
enqueue_pending_xmitbuf_to_head(pxmitpriv, pxmitbuf);
|
|
return _TRUE;
|
|
}
|
|
#else //CONFIG_SDIO_TX_ENABLE_AVAL_INT
|
|
polling_num++;
|
|
if ((polling_num % 0x7F) == 0) {//or 80
|
|
//DBG_871X("%s: FIFO starvation!(%d) len=%d agg=%d page=(R)%d(A)%d\n",
|
|
// __func__, polling_num, pxmitbuf->len, pxmitbuf->agg_num, pframe->pg_num, freePage[PageIdx] + freePage[PUBLIC_QUEUE_IDX]);
|
|
rtw_msleep_os(1);
|
|
}
|
|
|
|
// Total number of page is NOT available, so update current FIFO status
|
|
HalQueryTxBufferStatus8703BSdio(padapter);
|
|
goto query_free_page;
|
|
#endif //CONFIG_SDIO_TX_ENABLE_AVAL_INT
|
|
}
|
|
|
|
if (RTW_CANNOT_RUN(padapter)) {
|
|
RT_TRACE(_module_hal_xmit_c_, _drv_notice_,
|
|
("%s: bSurpriseRemoved(wirte port)\n", __FUNCTION__));
|
|
goto free_xmitbuf;
|
|
}
|
|
|
|
if (rtw_sdio_wait_enough_TxOQT_space(padapter, pxmitbuf->agg_num) == _FALSE)
|
|
{
|
|
goto free_xmitbuf;
|
|
}
|
|
|
|
#ifdef CONFIG_CHECK_LEAVE_LPS
|
|
traffic_check_for_leave_lps(padapter, _TRUE, pxmitbuf->agg_num);
|
|
#endif
|
|
|
|
rtw_write_port(padapter, deviceId, pxmitbuf->len, (u8 *)pxmitbuf);
|
|
|
|
rtw_hal_sdio_update_tx_freepage(padapter, PageIdx, pxmitbuf->pg_num);
|
|
|
|
free_xmitbuf:
|
|
//rtw_free_xmitframe(pxmitpriv, pframe);
|
|
//pxmitbuf->priv_data = NULL;
|
|
rtw_free_xmitbuf(pxmitpriv, pxmitbuf);
|
|
|
|
#if 0 // improve TX/RX throughput balance
|
|
{
|
|
PSDIO_DATA psdio;
|
|
struct sdio_func *func;
|
|
static u8 i = 0;
|
|
u32 sdio_hisr;
|
|
u8 j;
|
|
|
|
psdio = &adapter_to_dvobj(padapter)->intf_data;
|
|
func = psdio->func;
|
|
|
|
if (i == 2)
|
|
{
|
|
j = 0;
|
|
while (j < 10)
|
|
{
|
|
sdio_hisr = SdioLocalCmd52Read1Byte(padapter, SDIO_REG_HISR);
|
|
sdio_hisr &= GET_HAL_DATA(padapter)->sdio_himr;
|
|
if (sdio_hisr & SDIO_HISR_RX_REQUEST)
|
|
{
|
|
sdio_claim_host(func);
|
|
sd_int_hdl(GET_PRIMARY_ADAPTER(padapter));
|
|
sdio_release_host(func);
|
|
}
|
|
else
|
|
{
|
|
break;
|
|
}
|
|
j++;
|
|
}
|
|
i = 0;
|
|
}
|
|
else
|
|
{
|
|
i++;
|
|
}
|
|
}
|
|
#endif
|
|
|
|
#ifdef CONFIG_SDIO_TX_TASKLET
|
|
tasklet_hi_schedule(&pxmitpriv->xmit_tasklet);
|
|
#endif
|
|
|
|
return _FAIL;
|
|
}
|
|
|
|
/*
|
|
* Description
|
|
* Transmit xmitbuf to hardware tx fifo
|
|
*
|
|
* Return
|
|
* _SUCCESS ok
|
|
* _FAIL something error
|
|
*/
|
|
s32 rtl8703bs_xmit_buf_handler(PADAPTER padapter)
|
|
{
|
|
struct xmit_priv *pxmitpriv;
|
|
u8 queue_empty, queue_pending;
|
|
s32 ret;
|
|
|
|
|
|
pxmitpriv = &padapter->xmitpriv;
|
|
|
|
ret = _rtw_down_sema(&pxmitpriv->xmit_sema);
|
|
if (_FAIL == ret) {
|
|
DBG_871X_LEVEL(_drv_emerg_, "%s: down SdioXmitBufSema fail!\n", __FUNCTION__);
|
|
return _FAIL;
|
|
}
|
|
|
|
if (RTW_CANNOT_RUN(padapter)) {
|
|
RT_TRACE(_module_hal_xmit_c_, _drv_err_
|
|
, ("%s: bDriverStopped(%s) bSurpriseRemoved(%s)!\n"
|
|
, __func__
|
|
, rtw_is_drv_stopped(padapter)?"True":"False"
|
|
, rtw_is_surprise_removed(padapter)?"True":"False"));
|
|
return _FAIL;
|
|
}
|
|
|
|
queue_pending = check_pending_xmitbuf(pxmitpriv);
|
|
|
|
#ifdef CONFIG_CONCURRENT_MODE
|
|
if(rtw_buddy_adapter_up(padapter))
|
|
queue_pending |= check_pending_xmitbuf(&padapter->pbuddy_adapter->xmitpriv);
|
|
#endif
|
|
|
|
if(queue_pending == _FALSE)
|
|
return _SUCCESS;
|
|
|
|
#ifdef CONFIG_LPS_LCLK
|
|
ret = rtw_register_tx_alive(padapter);
|
|
if (ret != _SUCCESS) {
|
|
return _SUCCESS;
|
|
}
|
|
#endif
|
|
|
|
do {
|
|
queue_empty = rtl8703_dequeue_writeport(padapter);
|
|
// dump secondary adapter xmitbuf
|
|
#ifdef CONFIG_CONCURRENT_MODE
|
|
if(rtw_buddy_adapter_up(padapter))
|
|
queue_empty &= rtl8703_dequeue_writeport(padapter->pbuddy_adapter);
|
|
#endif
|
|
} while ( !queue_empty);
|
|
|
|
#ifdef CONFIG_LPS_LCLK
|
|
rtw_unregister_tx_alive(padapter);
|
|
#endif
|
|
|
|
return _SUCCESS;
|
|
}
|
|
|
|
/*
|
|
* Description:
|
|
* Aggregation packets and send to hardware
|
|
*
|
|
* Return:
|
|
* 0 Success
|
|
* -1 Hardware resource(TX FIFO) not ready
|
|
* -2 Software resource(xmitbuf) not ready
|
|
*/
|
|
static s32 xmit_xmitframes(PADAPTER padapter, struct xmit_priv *pxmitpriv)
|
|
{
|
|
s32 err, ret;
|
|
u32 k=0;
|
|
struct hw_xmit *hwxmits, *phwxmit;
|
|
u8 no_res, idx, hwentry;
|
|
_irqL irql;
|
|
struct tx_servq *ptxservq;
|
|
_list *sta_plist, *sta_phead, *frame_plist, *frame_phead;
|
|
struct xmit_frame *pxmitframe;
|
|
_queue *pframe_queue;
|
|
struct xmit_buf *pxmitbuf;
|
|
u32 txlen, max_xmit_len;
|
|
u8 txdesc_size = TXDESC_SIZE;
|
|
int inx[4];
|
|
u8 pre_qsel=0xFF,next_qsel=0xFF;
|
|
u8 single_sta_in_queue = _FALSE;
|
|
|
|
err = 0;
|
|
no_res = _FALSE;
|
|
hwxmits = pxmitpriv->hwxmits;
|
|
hwentry = pxmitpriv->hwxmit_entry;
|
|
ptxservq = NULL;
|
|
pxmitframe = NULL;
|
|
pframe_queue = NULL;
|
|
pxmitbuf = NULL;
|
|
|
|
if (padapter->registrypriv.wifi_spec == 1) {
|
|
for(idx=0; idx<4; idx++)
|
|
inx[idx] = pxmitpriv->wmm_para_seq[idx];
|
|
} else {
|
|
inx[0] = 0; inx[1] = 1; inx[2] = 2; inx[3] = 3;
|
|
}
|
|
|
|
// 0(VO), 1(VI), 2(BE), 3(BK)
|
|
for (idx = 0; idx < hwentry; idx++)
|
|
{
|
|
phwxmit = hwxmits + inx[idx];
|
|
|
|
if((check_pending_xmitbuf(pxmitpriv) == _TRUE) && (padapter->mlmepriv.LinkDetectInfo.bHigherBusyTxTraffic == _TRUE)) {
|
|
if ((phwxmit->accnt > 0) && (phwxmit->accnt < 5)) {
|
|
err = -2;
|
|
break;
|
|
}
|
|
}
|
|
|
|
max_xmit_len = rtw_hal_get_sdio_tx_max_length(padapter, inx[idx]);
|
|
|
|
_enter_critical_bh(&pxmitpriv->lock, &irql);
|
|
|
|
sta_phead = get_list_head(phwxmit->sta_queue);
|
|
sta_plist = get_next(sta_phead);
|
|
//because stop_sta_xmit may delete sta_plist at any time
|
|
//so we should add lock here, or while loop can not exit
|
|
|
|
single_sta_in_queue = rtw_end_of_queue_search(sta_phead, get_next(sta_plist));
|
|
|
|
while (rtw_end_of_queue_search(sta_phead, sta_plist) == _FALSE)
|
|
{
|
|
ptxservq = LIST_CONTAINOR(sta_plist, struct tx_servq, tx_pending);
|
|
sta_plist = get_next(sta_plist);
|
|
|
|
#ifdef DBG_XMIT_BUF
|
|
DBG_871X("%s idx:%d hwxmit_pkt_num:%d ptxservq_pkt_num:%d\n", __func__, idx, phwxmit->accnt, ptxservq->qcnt);
|
|
DBG_871X("%s free_xmit_extbuf_cnt=%d free_xmitbuf_cnt=%d free_xmitframe_cnt=%d \n",
|
|
__func__, pxmitpriv->free_xmit_extbuf_cnt, pxmitpriv->free_xmitbuf_cnt,
|
|
pxmitpriv->free_xmitframe_cnt);
|
|
#endif
|
|
pframe_queue = &ptxservq->sta_pending;
|
|
|
|
frame_phead = get_list_head(pframe_queue);
|
|
|
|
while (rtw_is_list_empty(frame_phead) == _FALSE)
|
|
{
|
|
frame_plist = get_next(frame_phead);
|
|
pxmitframe = LIST_CONTAINOR(frame_plist, struct xmit_frame, list);
|
|
|
|
// check xmit_buf size enough or not
|
|
txlen = txdesc_size + rtw_wlan_pkt_size(pxmitframe);
|
|
next_qsel = pxmitframe->attrib.qsel;
|
|
if ((NULL == pxmitbuf) ||
|
|
((_RND(pxmitbuf->len, 8) + txlen) > max_xmit_len)
|
|
|| (k >= (rtw_hal_sdio_max_txoqt_free_space(padapter)-1))
|
|
|| ((k!=0) && (_FAIL == rtw_hal_busagg_qsel_check(padapter,pre_qsel,next_qsel)))
|
|
)
|
|
{
|
|
if (pxmitbuf)
|
|
{
|
|
//pxmitbuf->priv_data will be NULL, and will crash here
|
|
if (pxmitbuf->len > 0 && pxmitbuf->priv_data)
|
|
{
|
|
struct xmit_frame *pframe;
|
|
pframe = (struct xmit_frame*)pxmitbuf->priv_data;
|
|
pframe->agg_num = k;
|
|
pxmitbuf->agg_num = k;
|
|
rtl8703b_update_txdesc(pframe, pframe->buf_addr);
|
|
rtw_free_xmitframe(pxmitpriv, pframe);
|
|
pxmitbuf->priv_data = NULL;
|
|
enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf);
|
|
//can not yield under lock
|
|
|
|
//rtw_yield_os();
|
|
if (single_sta_in_queue == _FALSE) {
|
|
/* break the loop in case there is more than one sta in this ac queue */
|
|
pxmitbuf = NULL;
|
|
err = -3;
|
|
break;
|
|
}
|
|
} else {
|
|
rtw_free_xmitbuf(pxmitpriv, pxmitbuf);
|
|
}
|
|
}
|
|
|
|
pxmitbuf = rtw_alloc_xmitbuf(pxmitpriv);
|
|
if (pxmitbuf == NULL) {
|
|
#ifdef DBG_XMIT_BUF
|
|
DBG_871X_LEVEL(_drv_err_, "%s: xmit_buf is not enough!\n", __FUNCTION__);
|
|
#endif
|
|
err = -2;
|
|
#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT
|
|
#ifdef CONFIG_CONCURRENT_MODE
|
|
if (padapter->adapter_type > PRIMARY_ADAPTER)
|
|
_rtw_up_sema(&(padapter->pbuddy_adapter->xmitpriv.xmit_sema));
|
|
else
|
|
#endif
|
|
_rtw_up_sema(&(pxmitpriv->xmit_sema));
|
|
#endif
|
|
break;
|
|
}
|
|
k = 0;
|
|
}
|
|
|
|
// ok to send, remove frame from queue
|
|
#ifdef CONFIG_AP_MODE
|
|
if (check_fwstate(&padapter->mlmepriv, WIFI_AP_STATE) == _TRUE) {
|
|
if ((pxmitframe->attrib.psta->state & WIFI_SLEEP_STATE) &&
|
|
(pxmitframe->attrib.triggered == 0)) {
|
|
DBG_871X("%s: one not triggered pkt in queue when this STA sleep,"
|
|
" break and goto next sta\n", __func__);
|
|
break;
|
|
}
|
|
}
|
|
#endif
|
|
rtw_list_delete(&pxmitframe->list);
|
|
ptxservq->qcnt--;
|
|
phwxmit->accnt--;
|
|
|
|
if (k == 0) {
|
|
pxmitbuf->ff_hwaddr = rtw_get_ff_hwaddr(pxmitframe);
|
|
pxmitbuf->priv_data = (u8*)pxmitframe;
|
|
}
|
|
|
|
// coalesce the xmitframe to xmitbuf
|
|
pxmitframe->pxmitbuf = pxmitbuf;
|
|
pxmitframe->buf_addr = pxmitbuf->ptail;
|
|
|
|
ret = rtw_xmitframe_coalesce(padapter, pxmitframe->pkt, pxmitframe);
|
|
if (ret == _FAIL) {
|
|
DBG_871X_LEVEL(_drv_err_, "%s: coalesce FAIL!", __FUNCTION__);
|
|
// Todo: error handler
|
|
} else {
|
|
k++;
|
|
if (k != 1)
|
|
rtl8703b_update_txdesc(pxmitframe, pxmitframe->buf_addr);
|
|
rtw_count_tx_stats(padapter, pxmitframe, pxmitframe->attrib.last_txcmdsz);
|
|
pre_qsel = pxmitframe->attrib.qsel;
|
|
txlen = txdesc_size + pxmitframe->attrib.last_txcmdsz;
|
|
pxmitframe->pg_num = (txlen + 127)/128;
|
|
pxmitbuf->pg_num += (txlen + 127)/128;
|
|
//if (k != 1)
|
|
// ((struct xmit_frame*)pxmitbuf->priv_data)->pg_num += pxmitframe->pg_num;
|
|
pxmitbuf->ptail += _RND(txlen, 8); // round to 8 bytes alignment
|
|
pxmitbuf->len = _RND(pxmitbuf->len, 8) + txlen;
|
|
}
|
|
|
|
if (k != 1)
|
|
rtw_free_xmitframe(pxmitpriv, pxmitframe);
|
|
pxmitframe = NULL;
|
|
}
|
|
|
|
if (_rtw_queue_empty(pframe_queue) == _TRUE)
|
|
rtw_list_delete(&ptxservq->tx_pending);
|
|
else if (err == -3) {
|
|
/* Re-arrange the order of stations in this ac queue to balance the service for these stations */
|
|
rtw_list_delete(&ptxservq->tx_pending);
|
|
rtw_list_insert_tail(&ptxservq->tx_pending, get_list_head(phwxmit->sta_queue));
|
|
}
|
|
|
|
if (err) break;
|
|
}
|
|
_exit_critical_bh(&pxmitpriv->lock, &irql);
|
|
|
|
// dump xmit_buf to hw tx fifo
|
|
if (pxmitbuf)
|
|
{
|
|
RT_TRACE(_module_hal_xmit_c_, _drv_info_, ("pxmitbuf->len=%d enqueue\n",pxmitbuf->len));
|
|
|
|
if (pxmitbuf->len > 0) {
|
|
struct xmit_frame *pframe;
|
|
pframe = (struct xmit_frame*)pxmitbuf->priv_data;
|
|
pframe->agg_num = k;
|
|
pxmitbuf->agg_num = k;
|
|
rtl8703b_update_txdesc(pframe, pframe->buf_addr);
|
|
rtw_free_xmitframe(pxmitpriv, pframe);
|
|
pxmitbuf->priv_data = NULL;
|
|
enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf);
|
|
rtw_yield_os();
|
|
}
|
|
else
|
|
rtw_free_xmitbuf(pxmitpriv, pxmitbuf);
|
|
pxmitbuf = NULL;
|
|
}
|
|
|
|
if (err == -2)
|
|
break;
|
|
}
|
|
|
|
return err;
|
|
}
|
|
|
|
/*
|
|
* Description
|
|
* Transmit xmitframe from queue
|
|
*
|
|
* Return
|
|
* _SUCCESS ok
|
|
* _FAIL something error
|
|
*/
|
|
s32 rtl8703bs_xmit_handler(PADAPTER padapter)
|
|
{
|
|
struct xmit_priv *pxmitpriv;
|
|
s32 ret;
|
|
_irqL irql;
|
|
|
|
|
|
pxmitpriv = &padapter->xmitpriv;
|
|
|
|
wait:
|
|
ret = _rtw_down_sema(&pxmitpriv->SdioXmitSema);
|
|
if (_FAIL == ret) {
|
|
DBG_871X_LEVEL(_drv_emerg_, "%s: down sema fail!\n", __FUNCTION__);
|
|
return _FAIL;
|
|
}
|
|
|
|
next:
|
|
if (RTW_CANNOT_RUN(padapter)) {
|
|
RT_TRACE(_module_hal_xmit_c_, _drv_notice_
|
|
, ("%s: bDriverStopped(%s) bSurpriseRemoved(%s)\n"
|
|
, __func__
|
|
, rtw_is_drv_stopped(padapter)?"True":"False"
|
|
, rtw_is_surprise_removed(padapter)?"True":"False"));
|
|
return _FAIL;
|
|
}
|
|
|
|
_enter_critical_bh(&pxmitpriv->lock, &irql);
|
|
ret = rtw_txframes_pending(padapter);
|
|
_exit_critical_bh(&pxmitpriv->lock, &irql);
|
|
if (ret == 0) {
|
|
return _SUCCESS;
|
|
}
|
|
|
|
// dequeue frame and write to hardware
|
|
|
|
ret = xmit_xmitframes(padapter, pxmitpriv);
|
|
if (ret == -2) {
|
|
//here sleep 1ms will cause big TP loss of TX
|
|
//from 50+ to 40+
|
|
if(padapter->registrypriv.wifi_spec)
|
|
rtw_msleep_os(1);
|
|
else
|
|
#ifdef CONFIG_REDUCE_TX_CPU_LOADING
|
|
rtw_msleep_os(1);
|
|
#else
|
|
rtw_usleep_os(50);
|
|
#endif
|
|
goto next;
|
|
}
|
|
|
|
_enter_critical_bh(&pxmitpriv->lock, &irql);
|
|
ret = rtw_txframes_pending(padapter);
|
|
_exit_critical_bh(&pxmitpriv->lock, &irql);
|
|
if (ret == 1) {
|
|
#ifdef CONFIG_REDUCE_TX_CPU_LOADING
|
|
rtw_msleep_os(1);
|
|
#endif
|
|
goto next;
|
|
}
|
|
|
|
return _SUCCESS;
|
|
}
|
|
|
|
thread_return rtl8703bs_xmit_thread(thread_context context)
|
|
{
|
|
s32 ret;
|
|
PADAPTER padapter;
|
|
struct xmit_priv *pxmitpriv;
|
|
u8 thread_name[20] = "RTWHALXT";
|
|
|
|
|
|
ret = _SUCCESS;
|
|
padapter = (PADAPTER)context;
|
|
pxmitpriv = &padapter->xmitpriv;
|
|
|
|
rtw_sprintf(thread_name, 20, "%s-"ADPT_FMT, thread_name, ADPT_ARG(padapter));
|
|
thread_enter(thread_name);
|
|
|
|
DBG_871X("start "FUNC_ADPT_FMT"\n", FUNC_ADPT_ARG(padapter));
|
|
|
|
// For now, no one would down sema to check thread is running,
|
|
// so mark this temporary, Lucas@20130820
|
|
// _rtw_up_sema(&pxmitpriv->SdioXmitTerminateSema);
|
|
|
|
do {
|
|
ret = rtl8703bs_xmit_handler(padapter);
|
|
if (signal_pending(current)) {
|
|
flush_signals(current);
|
|
}
|
|
} while (_SUCCESS == ret);
|
|
|
|
_rtw_up_sema(&pxmitpriv->SdioXmitTerminateSema);
|
|
|
|
RT_TRACE(_module_hal_xmit_c_, _drv_notice_, ("-%s\n", __FUNCTION__));
|
|
|
|
thread_exit();
|
|
}
|
|
|
|
s32 rtl8703bs_mgnt_xmit(PADAPTER padapter, struct xmit_frame *pmgntframe)
|
|
{
|
|
s32 ret = _SUCCESS;
|
|
struct pkt_attrib *pattrib;
|
|
struct xmit_buf *pxmitbuf;
|
|
struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
|
|
struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter);
|
|
u8 *pframe = (u8 *)(pmgntframe->buf_addr) + TXDESC_OFFSET;
|
|
u8 txdesc_size = TXDESC_SIZE;
|
|
|
|
RT_TRACE(_module_hal_xmit_c_, _drv_info_, ("+%s\n", __FUNCTION__));
|
|
|
|
pattrib = &pmgntframe->attrib;
|
|
pxmitbuf = pmgntframe->pxmitbuf;
|
|
|
|
rtl8703b_update_txdesc(pmgntframe, pmgntframe->buf_addr);
|
|
|
|
pxmitbuf->len = txdesc_size + pattrib->last_txcmdsz;
|
|
//pmgntframe->pg_num = (pxmitbuf->len + 127)/128; // 128 is tx page size
|
|
pxmitbuf->pg_num = (pxmitbuf->len + 127)/128; // 128 is tx page size
|
|
pxmitbuf->ptail = pmgntframe->buf_addr + pxmitbuf->len;
|
|
pxmitbuf->ff_hwaddr = rtw_get_ff_hwaddr(pmgntframe);
|
|
|
|
rtw_count_tx_stats(padapter, pmgntframe, pattrib->last_txcmdsz);
|
|
|
|
rtw_free_xmitframe(pxmitpriv, pmgntframe);
|
|
|
|
pxmitbuf->priv_data = NULL;
|
|
|
|
if(GetFrameSubType(pframe)==WIFI_BEACON) //dump beacon directly
|
|
{
|
|
ret = rtw_write_port(padapter, pdvobjpriv->Queue2Pipe[pxmitbuf->ff_hwaddr], pxmitbuf->len, (u8 *)pxmitbuf);
|
|
if (ret != _SUCCESS)
|
|
rtw_sctx_done_err(&pxmitbuf->sctx, RTW_SCTX_DONE_WRITE_PORT_ERR);
|
|
|
|
rtw_free_xmitbuf(pxmitpriv, pxmitbuf);
|
|
}
|
|
else
|
|
{
|
|
enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf);
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
/*
|
|
* Description:
|
|
* Handle xmitframe(packet) come from rtw_xmit()
|
|
*
|
|
* Return:
|
|
* _TRUE dump packet directly ok
|
|
* _FALSE enqueue, temporary can't transmit packets to hardware
|
|
*/
|
|
s32 rtl8703bs_hal_xmit(PADAPTER padapter, struct xmit_frame *pxmitframe)
|
|
{
|
|
struct xmit_priv *pxmitpriv;
|
|
_irqL irql;
|
|
s32 err;
|
|
|
|
|
|
pxmitframe->attrib.qsel = pxmitframe->attrib.priority;
|
|
pxmitpriv = &padapter->xmitpriv;
|
|
|
|
#ifdef CONFIG_80211N_HT
|
|
if ((pxmitframe->frame_tag == DATA_FRAMETAG) &&
|
|
(pxmitframe->attrib.ether_type != 0x0806) &&
|
|
(pxmitframe->attrib.ether_type != 0x888e) &&
|
|
(pxmitframe->attrib.dhcp_pkt != 1))
|
|
{
|
|
if (padapter->mlmepriv.LinkDetectInfo.bBusyTraffic == _TRUE)
|
|
rtw_issue_addbareq_cmd(padapter, pxmitframe);
|
|
}
|
|
#endif
|
|
|
|
_enter_critical_bh(&pxmitpriv->lock, &irql);
|
|
err = rtw_xmitframe_enqueue(padapter, pxmitframe);
|
|
_exit_critical_bh(&pxmitpriv->lock, &irql);
|
|
if (err != _SUCCESS) {
|
|
RT_TRACE(_module_hal_xmit_c_, _drv_err_, ("rtl8703bs_hal_xmit: enqueue xmitframe fail\n"));
|
|
rtw_free_xmitframe(pxmitpriv, pxmitframe);
|
|
|
|
pxmitpriv->tx_drop++;
|
|
return _TRUE;
|
|
}
|
|
|
|
_rtw_up_sema(&pxmitpriv->SdioXmitSema);
|
|
|
|
return _FALSE;
|
|
}
|
|
|
|
s32 rtl8703bs_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe)
|
|
{
|
|
struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
|
|
s32 err;
|
|
|
|
if ((err=rtw_xmitframe_enqueue(padapter, pxmitframe)) != _SUCCESS)
|
|
{
|
|
rtw_free_xmitframe(pxmitpriv, pxmitframe);
|
|
|
|
pxmitpriv->tx_drop++;
|
|
}
|
|
else
|
|
{
|
|
#ifdef CONFIG_SDIO_TX_TASKLET
|
|
tasklet_hi_schedule(&pxmitpriv->xmit_tasklet);
|
|
#else
|
|
_rtw_up_sema(&pxmitpriv->SdioXmitSema);
|
|
#endif
|
|
}
|
|
|
|
return err;
|
|
|
|
}
|
|
|
|
/*
|
|
* Return
|
|
* _SUCCESS start thread ok
|
|
* _FAIL start thread fail
|
|
*
|
|
*/
|
|
s32 rtl8703bs_init_xmit_priv(PADAPTER padapter)
|
|
{
|
|
struct xmit_priv *xmitpriv = &padapter->xmitpriv;
|
|
PHAL_DATA_TYPE phal;
|
|
|
|
|
|
phal = GET_HAL_DATA(padapter);
|
|
|
|
_rtw_spinlock_init(&phal->SdioTxFIFOFreePageLock);
|
|
_rtw_init_sema(&xmitpriv->SdioXmitSema, 0);
|
|
_rtw_init_sema(&xmitpriv->SdioXmitTerminateSema, 0);
|
|
|
|
return _SUCCESS;
|
|
}
|
|
|
|
void rtl8703bs_free_xmit_priv(PADAPTER padapter)
|
|
{
|
|
PHAL_DATA_TYPE phal;
|
|
struct xmit_priv *pxmitpriv;
|
|
struct xmit_buf *pxmitbuf;
|
|
_queue *pqueue;
|
|
_list *plist, *phead;
|
|
_list tmplist;
|
|
_irqL irql;
|
|
|
|
|
|
phal = GET_HAL_DATA(padapter);
|
|
pxmitpriv = &padapter->xmitpriv;
|
|
pqueue = &pxmitpriv->pending_xmitbuf_queue;
|
|
phead = get_list_head(pqueue);
|
|
_rtw_init_listhead(&tmplist);
|
|
|
|
_enter_critical_bh(&pqueue->lock, &irql);
|
|
if (_rtw_queue_empty(pqueue) == _FALSE)
|
|
{
|
|
// Insert tmplist to end of queue, and delete phead
|
|
// then tmplist become head of queue.
|
|
rtw_list_insert_tail(&tmplist, phead);
|
|
rtw_list_delete(phead);
|
|
}
|
|
_exit_critical_bh(&pqueue->lock, &irql);
|
|
|
|
phead = &tmplist;
|
|
while (rtw_is_list_empty(phead) == _FALSE)
|
|
{
|
|
plist = get_next(phead);
|
|
rtw_list_delete(plist);
|
|
|
|
pxmitbuf = LIST_CONTAINOR(plist, struct xmit_buf, list);
|
|
rtw_free_xmitframe(pxmitpriv, (struct xmit_frame*)pxmitbuf->priv_data);
|
|
pxmitbuf->priv_data = NULL;
|
|
rtw_free_xmitbuf(pxmitpriv, pxmitbuf);
|
|
}
|
|
|
|
_rtw_spinlock_free(&phal->SdioTxFIFOFreePageLock);
|
|
}
|
|
|