mirror of
https://github.com/amazingfate/rtl8723ds.git
synced 2026-06-18 18:29:01 +01:00
rtl8723ds: Initial commit of files
This repository contains the Realtek driver V5.1.1.5_20523.20161209_BTCOEX20161208-1212. At inclusion, the only changes from the Realtek version were to fix any compile warnings or errors. With these changes, the driver builds on kernels through 4.11. Signed-off-by: Larry Finger <Larry.Finger@lwfinger.net>
This commit is contained in:
Larry Finger
@@ -0,0 +1,126 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* 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 _RTL8723DS_LED_C_
|
||||
|
||||
#include "rtl8723d_hal.h"
|
||||
|
||||
/* ********************************************************************************
|
||||
* LED object.
|
||||
* ******************************************************************************** */
|
||||
|
||||
|
||||
/* ********************************************************************************
|
||||
* Prototype of protected function.
|
||||
* ******************************************************************************** */
|
||||
|
||||
/* ********************************************************************************
|
||||
* LED_819xUsb routines.
|
||||
* ******************************************************************************** */
|
||||
|
||||
/*
|
||||
* Description:
|
||||
* Turn on LED according to LedPin specified.
|
||||
* */
|
||||
void
|
||||
SwLedOn_8723DS(
|
||||
_adapter *padapter,
|
||||
PLED_SDIO pLed
|
||||
)
|
||||
{
|
||||
u8 LedCfg;
|
||||
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
||||
|
||||
if (RTW_CANNOT_RUN(padapter))
|
||||
return;
|
||||
|
||||
pLed->bLedOn = _TRUE;
|
||||
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Description:
|
||||
* Turn off LED according to LedPin specified.
|
||||
* */
|
||||
void
|
||||
SwLedOff_8723DS(
|
||||
_adapter *padapter,
|
||||
PLED_SDIO pLed
|
||||
)
|
||||
{
|
||||
u8 LedCfg;
|
||||
HAL_DATA_TYPE *pHalData = GET_HAL_DATA(padapter);
|
||||
|
||||
if (RTW_CANNOT_RUN(padapter))
|
||||
goto exit;
|
||||
|
||||
exit:
|
||||
pLed->bLedOn = _FALSE;
|
||||
|
||||
}
|
||||
|
||||
/* ********************************************************************************
|
||||
* Interface to manipulate LED objects.
|
||||
* ******************************************************************************** */
|
||||
|
||||
/* ********************************************************************************
|
||||
* Default LED behavior.
|
||||
* ******************************************************************************** */
|
||||
|
||||
/*
|
||||
* Description:
|
||||
* Initialize all LED_871x objects.
|
||||
* */
|
||||
void
|
||||
rtl8723ds_InitSwLeds(
|
||||
_adapter *padapter
|
||||
)
|
||||
{
|
||||
#if 0
|
||||
struct led_priv *pledpriv = &(padapter->ledpriv);
|
||||
|
||||
pledpriv->LedControlHandler = LedControlSDIO;
|
||||
|
||||
pledpriv->SwLedOn = SwLedOn_8723DS;
|
||||
pledpriv->SwLedOff = SwLedOff_8723DS;
|
||||
|
||||
InitLed871x(padapter, &(pledpriv->SwLed0), LED_PIN_LED0);
|
||||
|
||||
InitLed871x(padapter, &(pledpriv->SwLed1), LED_PIN_LED1);
|
||||
#endif
|
||||
}
|
||||
|
||||
|
||||
/*
|
||||
* Description:
|
||||
* DeInitialize all LED_819xUsb objects.
|
||||
* */
|
||||
void
|
||||
rtl8723ds_DeInitSwLeds(
|
||||
_adapter *padapter
|
||||
)
|
||||
{
|
||||
#if 0
|
||||
struct led_priv *ledpriv = &(padapter->ledpriv);
|
||||
|
||||
DeInitLed871x(&(ledpriv->SwLed0));
|
||||
DeInitLed871x(&(ledpriv->SwLed1));
|
||||
#endif
|
||||
}
|
||||
@@ -0,0 +1,500 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* 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 _RTL8723DS_RECV_C_
|
||||
|
||||
#include <rtl8723d_hal.h>
|
||||
|
||||
|
||||
static s32 initrecvbuf(struct recv_buf *precvbuf, PADAPTER padapter)
|
||||
{
|
||||
_rtw_init_listhead(&precvbuf->list);
|
||||
_rtw_spinlock_init(&precvbuf->recvbuf_lock);
|
||||
|
||||
precvbuf->adapter = padapter;
|
||||
|
||||
return _SUCCESS;
|
||||
}
|
||||
|
||||
static void freerecvbuf(struct recv_buf *precvbuf)
|
||||
{
|
||||
_rtw_spinlock_free(&precvbuf->recvbuf_lock);
|
||||
}
|
||||
|
||||
#ifdef CONFIG_SDIO_RX_COPY
|
||||
static void rtl8723ds_recv_tasklet(void *priv)
|
||||
{
|
||||
PADAPTER padapter;
|
||||
PHAL_DATA_TYPE pHalData;
|
||||
struct recv_priv *precvpriv;
|
||||
struct recv_buf *precvbuf;
|
||||
union recv_frame *precvframe;
|
||||
struct recv_frame_hdr *phdr;
|
||||
struct rx_pkt_attrib *pattrib;
|
||||
u8 *ptr;
|
||||
u32 pkt_len, pkt_offset;
|
||||
u8 rx_report_sz = 0;
|
||||
|
||||
|
||||
padapter = (PADAPTER)priv;
|
||||
pHalData = GET_HAL_DATA(padapter);
|
||||
precvpriv = &padapter->recvpriv;
|
||||
|
||||
do {
|
||||
precvbuf = rtw_dequeue_recvbuf(&precvpriv->recv_buf_pending_queue);
|
||||
if (NULL == precvbuf)
|
||||
break;
|
||||
|
||||
ptr = precvbuf->pdata;
|
||||
|
||||
while (ptr < precvbuf->ptail) {
|
||||
precvframe = rtw_alloc_recvframe(&precvpriv->free_recv_queue);
|
||||
if (precvframe == NULL) {
|
||||
RTW_INFO("%s: no enough recv frame!\n", __FUNCTION__);
|
||||
rtw_enqueue_recvbuf_to_head(precvbuf, &precvpriv->recv_buf_pending_queue);
|
||||
|
||||
/* The case of can't allocate recvframe should be temporary, */
|
||||
/* schedule again and hope recvframe is available next time. */
|
||||
#ifdef PLATFORM_LINUX
|
||||
tasklet_schedule(&precvpriv->recv_tasklet);
|
||||
#endif
|
||||
return;
|
||||
}
|
||||
|
||||
/* rx desc parsing */
|
||||
rtl8723d_query_rx_desc_status(precvframe, ptr);
|
||||
|
||||
pattrib = &precvframe->u.hdr.attrib;
|
||||
|
||||
/* fix Hardware RX data error, drop whole recv_buffer */
|
||||
if ((!(pHalData->ReceiveConfig & RCR_ACRC32)) && pattrib->crc_err) {
|
||||
#if !(MP_DRIVER == 1)
|
||||
RTW_INFO("%s()-%d: RX Warning! rx CRC ERROR !!\n", __FUNCTION__, __LINE__);
|
||||
#endif
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
break;
|
||||
}
|
||||
|
||||
rx_report_sz = RXDESC_SIZE + pattrib->drvinfo_sz;
|
||||
pkt_offset = rx_report_sz + pattrib->shift_sz + pattrib->pkt_len;
|
||||
|
||||
if ((ptr + pkt_offset) > precvbuf->ptail) {
|
||||
RTW_INFO("%s()-%d: : next pkt len(%p,%d) exceed ptail(%p)!\n", __FUNCTION__, __LINE__, ptr, pkt_offset, precvbuf->ptail);
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
break;
|
||||
}
|
||||
|
||||
if ((pattrib->crc_err) || (pattrib->icv_err)) {
|
||||
#ifdef CONFIG_MP_INCLUDED
|
||||
if (padapter->registrypriv.mp_mode == 1) {
|
||||
if (check_fwstate(&padapter->mlmepriv, WIFI_MP_STATE) == _TRUE) { /* &&(padapter->mppriv.check_mp_pkt == 0)) */
|
||||
if (pattrib->crc_err == 1)
|
||||
padapter->mppriv.rx_crcerrpktcount++;
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
RTW_INFO("%s: crc_err=%d icv_err=%d, skip!\n", __FUNCTION__, pattrib->crc_err, pattrib->icv_err);
|
||||
}
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
} else {
|
||||
#ifdef CONFIG_RX_PACKET_APPEND_FCS
|
||||
if (check_fwstate(&padapter->mlmepriv, WIFI_MONITOR_STATE) == _FALSE)
|
||||
if ((pattrib->pkt_rpt_type == NORMAL_RX) && (pHalData->ReceiveConfig & RCR_APPFCS))
|
||||
pattrib->pkt_len -= IEEE80211_FCS_LEN;
|
||||
#endif
|
||||
|
||||
if (rtw_os_alloc_recvframe(padapter, precvframe,
|
||||
(ptr + rx_report_sz + pattrib->shift_sz), precvbuf->pskb) == _FAIL) {
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
break;
|
||||
}
|
||||
|
||||
recvframe_put(precvframe, pattrib->pkt_len);
|
||||
/* move to drv info position */
|
||||
ptr += RXDESC_SIZE;
|
||||
|
||||
/* update drv info */
|
||||
if (pHalData->ReceiveConfig & RCR_APP_BA_SSN) {
|
||||
/* rtl8723s_update_bassn(padapter, pdrvinfo); */
|
||||
ptr += 4;
|
||||
}
|
||||
|
||||
if (pattrib->pkt_rpt_type == NORMAL_RX) {
|
||||
/* skip the rx packet with abnormal length */
|
||||
if (pattrib->pkt_len < 14 || pattrib->pkt_len > 8192) {
|
||||
RTW_INFO("skip abnormal rx packet(%d)\n", pattrib->pkt_len);
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
break;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_CONCURRENT_MODE
|
||||
pre_recv_entry(precvframe, ptr);
|
||||
#endif
|
||||
|
||||
if (pattrib->physt)
|
||||
rx_query_phy_status(precvframe, ptr);
|
||||
|
||||
rtw_recv_entry(precvframe);
|
||||
} else {
|
||||
#ifdef CONFIG_FW_C2H_PKT
|
||||
if (pattrib->pkt_rpt_type == C2H_PACKET)
|
||||
rtw_hal_c2h_pkt_pre_hdl(padapter, precvframe->u.hdr.rx_data, pattrib->pkt_len);
|
||||
else {
|
||||
RTW_INFO("%s: [WARNNING] RX type(%d) not be handled!\n",
|
||||
__FUNCTION__, pattrib->pkt_rpt_type);
|
||||
}
|
||||
#endif
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
}
|
||||
}
|
||||
|
||||
pkt_offset = _RND8(pkt_offset);
|
||||
precvbuf->pdata += pkt_offset;
|
||||
ptr = precvbuf->pdata;
|
||||
precvframe = NULL;
|
||||
}
|
||||
|
||||
rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue);
|
||||
} while (1);
|
||||
|
||||
}
|
||||
#else
|
||||
static void rtl8723ds_recv_tasklet(void *priv)
|
||||
{
|
||||
PADAPTER padapter;
|
||||
PHAL_DATA_TYPE pHalData;
|
||||
struct recv_priv *precvpriv;
|
||||
struct recv_buf *precvbuf;
|
||||
union recv_frame *precvframe;
|
||||
struct recv_frame_hdr *phdr;
|
||||
struct rx_pkt_attrib *pattrib;
|
||||
u8 *ptr;
|
||||
_pkt *ppkt;
|
||||
u32 pkt_offset;
|
||||
|
||||
padapter = (PADAPTER)priv;
|
||||
pHalData = GET_HAL_DATA(padapter);
|
||||
precvpriv = &padapter->recvpriv;
|
||||
|
||||
do {
|
||||
precvbuf = rtw_dequeue_recvbuf(&precvpriv->recv_buf_pending_queue);
|
||||
if (NULL == precvbuf)
|
||||
break;
|
||||
|
||||
ptr = precvbuf->pdata;
|
||||
|
||||
while (ptr < precvbuf->ptail) {
|
||||
precvframe = rtw_alloc_recvframe(&precvpriv->free_recv_queue);
|
||||
if (precvframe == NULL) {
|
||||
rtw_enqueue_recvbuf_to_head(precvbuf, &precvpriv->recv_buf_pending_queue);
|
||||
|
||||
/* The case of can't allocate recvframe should be temporary, */
|
||||
/* schedule again and hope recvframe is available next time. */
|
||||
#ifdef PLATFORM_LINUX
|
||||
tasklet_schedule(&precvpriv->recv_tasklet);
|
||||
#endif
|
||||
return;
|
||||
}
|
||||
|
||||
phdr = &precvframe->u.hdr;
|
||||
pattrib = &phdr->attrib;
|
||||
|
||||
rtl8723d_query_rx_desc_status(precvframe, ptr);
|
||||
|
||||
#if 0
|
||||
{
|
||||
int i, len = 64;
|
||||
u8 *pptr = ptr;
|
||||
|
||||
if ((*(pptr + RXDESC_SIZE + pattrib->drvinfo_sz) != 0x80) && (*(pptr + RXDESC_SIZE + pattrib->drvinfo_sz) != 0x40)) {
|
||||
RTW_INFO("##############RxDESC###############\n");
|
||||
for (i = 0; i < 32; i = i + 16)
|
||||
RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(pptr + i),
|
||||
*(pptr + i + 1), *(pptr + i + 2) , *(pptr + i + 3) , *(pptr + i + 4), *(pptr + i + 5), *(pptr + i + 6), *(pptr + i + 7), *(pptr + i + 8),
|
||||
*(pptr + i + 9), *(pptr + i + 10),
|
||||
*(pptr + i + 11), *(pptr + i + 12), *(pptr + i + 13), *(pptr + i + 14), *(pptr + i + 15));
|
||||
|
||||
if (pattrib->pkt_len < 100)
|
||||
len = pattrib->pkt_len;
|
||||
pptr = ptr + RXDESC_SIZE + pattrib->drvinfo_sz;
|
||||
RTW_INFO("##############Len=%d###############\n", pattrib->pkt_len);
|
||||
for (i = 0; i < len; i = i + 16)
|
||||
RTW_INFO("%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:%02X:\n", *(pptr + i),
|
||||
*(pptr + i + 1), *(pptr + i + 2) , *(pptr + i + 3) , *(pptr + i + 4), *(pptr + i + 5), *(pptr + i + 6), *(pptr + i + 7), *(pptr + i + 8),
|
||||
*(pptr + i + 9), *(pptr + i + 10),
|
||||
*(pptr + i + 11), *(pptr + i + 12), *(pptr + i + 13), *(pptr + i + 14), *(pptr + i + 15));
|
||||
RTW_INFO("#############################\n");
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
/* fix Hardware RX data error, drop whole recv_buffer */
|
||||
if ((!(pHalData->ReceiveConfig & RCR_ACRC32)) && pattrib->crc_err) {
|
||||
RTW_INFO("%s()-%d: RX Warning! rx CRC ERROR !!\n", __FUNCTION__, __LINE__);
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
break;
|
||||
}
|
||||
|
||||
pkt_offset = RXDESC_SIZE + pattrib->drvinfo_sz + pattrib->pkt_len;
|
||||
#if 0 /* reduce check to speed up */
|
||||
if ((ptr + pkt_offset) > precvbuf->ptail) {
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
break;
|
||||
}
|
||||
#endif
|
||||
|
||||
if ((pattrib->crc_err) || (pattrib->icv_err)) {
|
||||
#ifdef CONFIG_MP_INCLUDED
|
||||
if (padapter->registrypriv.mp_mode == 1) {
|
||||
if (check_fwstate(&padapter->mlmepriv, WIFI_MP_STATE) == _TRUE) { /* &&(padapter->mppriv.check_mp_pkt == 0)) */
|
||||
if (pattrib->crc_err == 1)
|
||||
padapter->mppriv.rx_crcerrpktcount++;
|
||||
}
|
||||
} else
|
||||
#endif
|
||||
{
|
||||
RTW_INFO("%s: crc_err=%d icv_err=%d, skip!\n", __FUNCTION__, pattrib->crc_err, pattrib->icv_err);
|
||||
}
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
} else {
|
||||
ppkt = rtw_skb_clone(precvbuf->pskb);
|
||||
if (ppkt == NULL) {
|
||||
RTW_INFO("%s: no enough memory to allocate SKB!\n", __FUNCTION__);
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
rtw_enqueue_recvbuf_to_head(precvbuf, &precvpriv->recv_buf_pending_queue);
|
||||
|
||||
/* The case of can't allocate skb is serious and may never be recovered, */
|
||||
/* once bDriverStopped is enable, this task should be stopped. */
|
||||
if (!rtw_is_drv_stopped(padapter)) {
|
||||
#ifdef PLATFORM_LINUX
|
||||
tasklet_schedule(&precvpriv->recv_tasklet);
|
||||
#endif
|
||||
}
|
||||
|
||||
return;
|
||||
}
|
||||
|
||||
phdr->pkt = ppkt;
|
||||
phdr->len = 0;
|
||||
phdr->rx_head = precvbuf->phead;
|
||||
phdr->rx_data = phdr->rx_tail = precvbuf->pdata;
|
||||
phdr->rx_end = precvbuf->pend;
|
||||
recvframe_put(precvframe, pkt_offset);
|
||||
recvframe_pull(precvframe, RXDESC_SIZE + pattrib->drvinfo_sz);
|
||||
skb_pull(ppkt, RXDESC_SIZE + pattrib->drvinfo_sz);
|
||||
|
||||
#ifdef CONFIG_RX_PACKET_APPEND_FCS
|
||||
if (check_fwstate(&padapter->mlmepriv, WIFI_MONITOR_STATE) == _FALSE) {
|
||||
if ((pattrib->pkt_rpt_type == NORMAL_RX) && (pHalData->ReceiveConfig & RCR_APPFCS)) {
|
||||
recvframe_pull_tail(precvframe, IEEE80211_FCS_LEN);
|
||||
pattrib->pkt_len -= IEEE80211_FCS_LEN;
|
||||
ppkt->len = pattrib->pkt_len;
|
||||
}
|
||||
}
|
||||
#endif
|
||||
|
||||
/* move to drv info position */
|
||||
ptr += RXDESC_SIZE;
|
||||
|
||||
/* update drv info */
|
||||
if (pHalData->ReceiveConfig & RCR_APP_BA_SSN) {
|
||||
/* rtl8723s_update_bassn(padapter, pdrvinfo); */
|
||||
ptr += 4;
|
||||
}
|
||||
|
||||
if (pattrib->pkt_rpt_type == NORMAL_RX) {
|
||||
#ifdef CONFIG_CONCURRENT_MODE
|
||||
pre_recv_entry(precvframe, ptr);
|
||||
#endif /*CONFIG_CONCURRENT_MODE*/
|
||||
|
||||
if (pattrib->physt)
|
||||
rx_query_phy_status(precvframe, ptr);
|
||||
|
||||
rtw_recv_entry(precvframe);
|
||||
} else {
|
||||
#ifdef CONFIG_FW_C2H_PKT
|
||||
if (pattrib->pkt_rpt_type == C2H_PACKET)
|
||||
rtw_hal_c2h_pkt_pre_hdl(padapter, precvframe->u.hdr.rx_data, pattrib->pkt_len);
|
||||
else {
|
||||
RTW_INFO("%s: [WARNNING] RX type(%d) not be handled!\n",
|
||||
__FUNCTION__, pattrib->pkt_rpt_type);
|
||||
}
|
||||
#endif
|
||||
rtw_free_recvframe(precvframe, &precvpriv->free_recv_queue);
|
||||
}
|
||||
}
|
||||
|
||||
pkt_offset = _RND8(pkt_offset);
|
||||
precvbuf->pdata += pkt_offset;
|
||||
ptr = precvbuf->pdata;
|
||||
}
|
||||
|
||||
rtw_skb_free(precvbuf->pskb);
|
||||
precvbuf->pskb = NULL;
|
||||
rtw_enqueue_recvbuf(precvbuf, &precvpriv->free_recv_buf_queue);
|
||||
} while (1);
|
||||
}
|
||||
#endif
|
||||
|
||||
/*
|
||||
* Initialize recv private variable for hardware dependent
|
||||
* 1. recv buf
|
||||
* 2. recv tasklet
|
||||
*
|
||||
*/
|
||||
s32 rtl8723ds_init_recv_priv(PADAPTER padapter)
|
||||
{
|
||||
s32 res;
|
||||
u32 i, n;
|
||||
struct recv_priv *precvpriv;
|
||||
struct recv_buf *precvbuf;
|
||||
|
||||
|
||||
res = _SUCCESS;
|
||||
precvpriv = &padapter->recvpriv;
|
||||
|
||||
/* 3 1. init recv buffer */
|
||||
_rtw_init_queue(&precvpriv->free_recv_buf_queue);
|
||||
_rtw_init_queue(&precvpriv->recv_buf_pending_queue);
|
||||
|
||||
n = NR_RECVBUFF * sizeof(struct recv_buf) + 4;
|
||||
precvpriv->pallocated_recv_buf = rtw_zmalloc(n);
|
||||
if (precvpriv->pallocated_recv_buf == NULL) {
|
||||
res = _FAIL;
|
||||
goto exit;
|
||||
}
|
||||
|
||||
precvpriv->precv_buf = (u8 *)N_BYTE_ALIGMENT((SIZE_PTR)(precvpriv->pallocated_recv_buf), 4);
|
||||
|
||||
/* init each recv buffer */
|
||||
precvbuf = (struct recv_buf *)precvpriv->precv_buf;
|
||||
for (i = 0; i < NR_RECVBUFF; i++) {
|
||||
res = initrecvbuf(precvbuf, padapter);
|
||||
if (res == _FAIL)
|
||||
break;
|
||||
|
||||
res = rtw_os_recvbuf_resource_alloc(padapter, precvbuf);
|
||||
if (res == _FAIL) {
|
||||
freerecvbuf(precvbuf);
|
||||
break;
|
||||
}
|
||||
|
||||
#ifdef CONFIG_SDIO_RX_COPY
|
||||
if (precvbuf->pskb == NULL) {
|
||||
SIZE_PTR tmpaddr = 0;
|
||||
SIZE_PTR alignment = 0;
|
||||
|
||||
precvbuf->pskb = rtw_skb_alloc(MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ);
|
||||
|
||||
if (precvbuf->pskb) {
|
||||
precvbuf->pskb->dev = padapter->pnetdev;
|
||||
|
||||
tmpaddr = (SIZE_PTR)precvbuf->pskb->data;
|
||||
alignment = tmpaddr & (RECVBUFF_ALIGN_SZ - 1);
|
||||
skb_reserve(precvbuf->pskb, (RECVBUFF_ALIGN_SZ - alignment));
|
||||
}
|
||||
|
||||
if (precvbuf->pskb == NULL)
|
||||
RTW_INFO("%s: alloc_skb fail!\n", __FUNCTION__);
|
||||
}
|
||||
#endif
|
||||
|
||||
rtw_list_insert_tail(&precvbuf->list, &precvpriv->free_recv_buf_queue.queue);
|
||||
|
||||
precvbuf++;
|
||||
}
|
||||
precvpriv->free_recv_buf_queue_cnt = i;
|
||||
|
||||
if (res == _FAIL)
|
||||
goto initbuferror;
|
||||
|
||||
/* 3 2. init tasklet */
|
||||
#ifdef PLATFORM_LINUX
|
||||
tasklet_init(&precvpriv->recv_tasklet,
|
||||
(void(*)(unsigned long))rtl8723ds_recv_tasklet,
|
||||
(unsigned long)padapter);
|
||||
#endif
|
||||
|
||||
goto exit;
|
||||
|
||||
initbuferror:
|
||||
precvbuf = (struct recv_buf *)precvpriv->precv_buf;
|
||||
if (precvbuf) {
|
||||
n = precvpriv->free_recv_buf_queue_cnt;
|
||||
precvpriv->free_recv_buf_queue_cnt = 0;
|
||||
for (i = 0; i < n ; i++) {
|
||||
rtw_list_delete(&precvbuf->list);
|
||||
rtw_os_recvbuf_resource_free(padapter, precvbuf);
|
||||
freerecvbuf(precvbuf);
|
||||
precvbuf++;
|
||||
}
|
||||
precvpriv->precv_buf = NULL;
|
||||
}
|
||||
|
||||
if (precvpriv->pallocated_recv_buf) {
|
||||
n = NR_RECVBUFF * sizeof(struct recv_buf) + 4;
|
||||
rtw_mfree(precvpriv->pallocated_recv_buf, n);
|
||||
precvpriv->pallocated_recv_buf = NULL;
|
||||
}
|
||||
|
||||
exit:
|
||||
return res;
|
||||
}
|
||||
|
||||
/*
|
||||
* Free recv private variable of hardware dependent
|
||||
* 1. recv buf
|
||||
* 2. recv tasklet
|
||||
*
|
||||
*/
|
||||
void rtl8723ds_free_recv_priv(PADAPTER padapter)
|
||||
{
|
||||
u32 i, n;
|
||||
struct recv_priv *precvpriv;
|
||||
struct recv_buf *precvbuf;
|
||||
|
||||
|
||||
precvpriv = &padapter->recvpriv;
|
||||
|
||||
/* 3 1. kill tasklet */
|
||||
#ifdef PLATFORM_LINUX
|
||||
tasklet_kill(&precvpriv->recv_tasklet);
|
||||
#endif
|
||||
|
||||
/* 3 2. free all recv buffers */
|
||||
precvbuf = (struct recv_buf *)precvpriv->precv_buf;
|
||||
if (precvbuf) {
|
||||
n = NR_RECVBUFF;
|
||||
precvpriv->free_recv_buf_queue_cnt = 0;
|
||||
for (i = 0; i < n ; i++) {
|
||||
rtw_list_delete(&precvbuf->list);
|
||||
rtw_os_recvbuf_resource_free(padapter, precvbuf);
|
||||
freerecvbuf(precvbuf);
|
||||
precvbuf++;
|
||||
}
|
||||
precvpriv->precv_buf = NULL;
|
||||
}
|
||||
|
||||
if (precvpriv->pallocated_recv_buf) {
|
||||
n = NR_RECVBUFF * sizeof(struct recv_buf) + 4;
|
||||
rtw_mfree(precvpriv->pallocated_recv_buf, n);
|
||||
precvpriv->pallocated_recv_buf = NULL;
|
||||
}
|
||||
}
|
||||
@@ -0,0 +1,723 @@
|
||||
/******************************************************************************
|
||||
*
|
||||
* 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 _RTL8723DS_XMIT_C_
|
||||
|
||||
#include <rtl8723d_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)) {
|
||||
RTW_INFO("%s: bSurpriseRemoved or bDriverStopped (wait TxOQT)\n", __func__);
|
||||
return _FALSE;
|
||||
}
|
||||
|
||||
HalQueryTxOQTBufferStatus8723DSdio(padapter);
|
||||
|
||||
if ((++n % 60) == 0) {
|
||||
if ((n % 300) == 0) {
|
||||
RTW_INFO("%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;
|
||||
}
|
||||
|
||||
s32 _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
|
||||
|
||||
pxmitbuf = select_and_dequeue_pending_xmitbuf(padapter);
|
||||
|
||||
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)) {
|
||||
if (RTW_CANNOT_RUN(padapter))
|
||||
goto free_xmitbuf;
|
||||
#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT
|
||||
if (!bUpdatePageNum) {
|
||||
/* Total number of page is NOT available, so update current FIFO status */
|
||||
HalQueryTxBufferStatus8723DSdio(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 % 0x10) == 0) {
|
||||
/* RTW_INFO("%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]); */
|
||||
enqueue_pending_xmitbuf_to_head(pxmitpriv, pxmitbuf);
|
||||
rtw_usleep_os(50);
|
||||
return _FALSE;
|
||||
}
|
||||
|
||||
/* Total number of page is NOT available, so update current FIFO status */
|
||||
HalQueryTxBufferStatus8723DSdio(padapter);
|
||||
goto query_free_page;
|
||||
#endif /* CONFIG_SDIO_TX_ENABLE_AVAL_INT */
|
||||
}
|
||||
|
||||
#ifdef CONFIG_LPS_POFF
|
||||
if (rtl8723d_lps_poff_get_txbndy_status(padapter) == _TRUE) {
|
||||
RTW_INFO("%s: enqueue xmitbuf to pending queue head~~~\n",
|
||||
__func__);
|
||||
enqueue_pending_xmitbuf_to_head(pxmitpriv, pxmitbuf);
|
||||
return _TRUE;
|
||||
}
|
||||
#endif
|
||||
|
||||
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 _FALSE;
|
||||
}
|
||||
|
||||
/*
|
||||
* Description
|
||||
* Transmit xmitbuf to hardware tx fifo
|
||||
*
|
||||
* Return
|
||||
* _SUCCESS ok
|
||||
* _FAIL something error
|
||||
*/
|
||||
s32 rtl8723ds_xmit_buf_handler(PADAPTER padapter)
|
||||
{
|
||||
struct xmit_priv *pxmitpriv;
|
||||
u8 queue_empty;
|
||||
s32 ret;
|
||||
|
||||
|
||||
pxmitpriv = &padapter->xmitpriv;
|
||||
|
||||
ret = _rtw_down_sema(&pxmitpriv->xmit_sema);
|
||||
if (_FAIL == ret) {
|
||||
RTW_ERR("%s: down SdioXmitBufSema fail!\n", __func__);
|
||||
return _FAIL;
|
||||
}
|
||||
|
||||
if (RTW_CANNOT_RUN(padapter)) {
|
||||
return _FAIL;
|
||||
}
|
||||
|
||||
if (rtw_mi_check_pending_xmitbuf(padapter) == 0)
|
||||
return _SUCCESS;
|
||||
|
||||
#ifdef CONFIG_LPS_LCLK
|
||||
ret = rtw_register_tx_alive(padapter);
|
||||
if (ret != _SUCCESS)
|
||||
return _SUCCESS;
|
||||
#endif
|
||||
do {
|
||||
queue_empty = rtw_mi_dequeue_writeport(padapter);
|
||||
} 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, page_size;
|
||||
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;
|
||||
|
||||
rtw_hal_get_def_var(padapter, HAL_DEF_TX_PAGE_SIZE, &page_size);
|
||||
|
||||
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
|
||||
RTW_INFO("%s idx:%d hwxmit_pkt_num:%d ptxservq_pkt_num:%d\n", __func__, idx, phwxmit->accnt, ptxservq->qcnt);
|
||||
RTW_INFO("%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) ||
|
||||
(pxmitbuf->pg_num + PageNum(txlen, page_size) > PageNum(max_xmit_len, page_size))
|
||||
|| (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;
|
||||
rtl8723d_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
|
||||
RTW_ERR("%s: xmit_buf is not enough!\n", __func__);
|
||||
#endif
|
||||
err = -2;
|
||||
#ifdef CONFIG_SDIO_TX_ENABLE_AVAL_INT
|
||||
_rtw_up_sema(&(GET_PRIMARY_ADAPTER(padapter)->xmitpriv.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)) {
|
||||
RTW_INFO("%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) {
|
||||
RTW_ERR("%s: coalesce FAIL!", __func__);
|
||||
/* Todo: error handler */
|
||||
} else {
|
||||
k++;
|
||||
if (k != 1)
|
||||
rtl8723d_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) {
|
||||
|
||||
if (pxmitbuf->len > 0) {
|
||||
struct xmit_frame *pframe;
|
||||
|
||||
pframe = (struct xmit_frame *)pxmitbuf->priv_data;
|
||||
pframe->agg_num = k;
|
||||
pxmitbuf->agg_num = k;
|
||||
rtl8723d_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 rtl8723ds_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) {
|
||||
RTW_ERR("%s: down sema fail!\n", __func__);
|
||||
return _FAIL;
|
||||
}
|
||||
|
||||
next:
|
||||
if (RTW_CANNOT_RUN(padapter)) {
|
||||
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_yield_os();
|
||||
#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 rtl8723ds_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);
|
||||
|
||||
RTW_INFO("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 = rtl8723ds_xmit_handler(padapter);
|
||||
if (signal_pending(current))
|
||||
flush_signals(current);
|
||||
} while (_SUCCESS == ret);
|
||||
|
||||
_rtw_up_sema(&pxmitpriv->SdioXmitTerminateSema);
|
||||
|
||||
|
||||
thread_exit();
|
||||
}
|
||||
|
||||
s32 rtl8723ds_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;
|
||||
|
||||
|
||||
pattrib = &pmgntframe->attrib;
|
||||
pxmitbuf = pmgntframe->pxmitbuf;
|
||||
|
||||
rtl8723d_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 ||
|
||||
pxmitbuf->buf_tag == XMITBUF_CMD) {
|
||||
|
||||
#ifdef CONFIG_LPS_POFF
|
||||
if (rtl8723d_lps_poff_get_txbndy_status(padapter) == _TRUE) {
|
||||
RTW_INFO("%s: enqueue xmitbuf to pending queue ~~~\n",
|
||||
__func__);
|
||||
enqueue_pending_xmitbuf(pxmitpriv, pxmitbuf);
|
||||
return ret;
|
||||
}
|
||||
#endif
|
||||
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 rtl8723ds_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) {
|
||||
rtw_free_xmitframe(pxmitpriv, pxmitframe);
|
||||
|
||||
pxmitpriv->tx_drop++;
|
||||
return _TRUE;
|
||||
}
|
||||
|
||||
_rtw_up_sema(&pxmitpriv->SdioXmitSema);
|
||||
|
||||
return _FALSE;
|
||||
}
|
||||
|
||||
s32 rtl8723ds_hal_xmitframe_enqueue(_adapter *padapter, struct xmit_frame *pxmitframe)
|
||||
{
|
||||
struct xmit_priv *pxmitpriv = &padapter->xmitpriv;
|
||||
s32 err;
|
||||
|
||||
err = rtw_xmitframe_enqueue(padapter, pxmitframe);
|
||||
if (err != _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 rtl8723ds_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 rtl8723ds_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);
|
||||
}
|
||||
File diff suppressed because it is too large
Load Diff
File diff suppressed because it is too large
Load Diff
Reference in New Issue
Block a user