2013-05-08 21:45:39 +00:00
/******************************************************************************
*
* Copyright ( c ) 2007 - 2011 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 _HCI_OPS_OS_C_
# include <drv_conf.h>
# include <osdep_service.h>
# include <drv_types.h>
# include <osdep_intf.h>
# include <usb_ops.h>
# include <circ_buf.h>
# include <recv_osdep.h>
# include <rtl8188e_hal.h>
# if defined (PLATFORM_LINUX) && defined (PLATFORM_WINDOWS)
# error "Shall be Linux or Windows, but not both!\n"
# endif
static int usbctrl_vendorreq ( struct intf_hdl * pintfhdl , u8 request , u16 value , u16 index , void * pdata , u16 len , u8 requesttype )
{
_adapter * padapter = pintfhdl - > padapter ;
struct dvobj_priv * pdvobjpriv = adapter_to_dvobj ( padapter ) ;
struct usb_device * udev = pdvobjpriv - > pusbdev ;
unsigned int pipe ;
int status = 0 ;
u32 tmp_buflen = 0 ;
u8 reqtype ;
u8 * pIo_buf ;
int vendorreq_times = 0 ;
# ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE
u8 * tmp_buf ;
# else // use stack memory
u8 tmp_buf [ MAX_USB_IO_CTL_SIZE ] ;
# endif
# ifdef CONFIG_CONCURRENT_MODE
2013-05-09 04:04:25 +00:00
if ( padapter - > adapter_type > PRIMARY_ADAPTER )
2013-05-08 21:45:39 +00:00
{
padapter = padapter - > pbuddy_adapter ;
pdvobjpriv = adapter_to_dvobj ( padapter ) ;
udev = pdvobjpriv - > pusbdev ;
}
# endif
2013-05-09 16:23:32 +00:00
//DBG_871X("%s %s:%d\n",__func__, current->comm, current->pid);
2013-05-08 21:45:39 +00:00
2013-05-09 04:04:25 +00:00
if ( ( padapter - > bSurpriseRemoved ) | | ( padapter - > pwrctrlpriv . pnp_bstop_trx ) ) {
2013-05-08 21:45:39 +00:00
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usbctrl_vendorreq:(padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!! \n " ) ) ;
status = - EPERM ;
goto exit ;
}
2013-05-09 04:04:25 +00:00
if ( len > MAX_VENDOR_REQ_CMD_SIZE ) {
2013-05-09 16:23:32 +00:00
DBG_8192C ( " [%s] Buffer len error ,vendor request failed \n " , __func__ ) ;
2013-05-08 21:45:39 +00:00
status = - EINVAL ;
goto exit ;
}
# ifdef CONFIG_USB_VENDOR_REQ_MUTEX
_enter_critical_mutex ( & pdvobjpriv - > usb_vendor_req_mutex , NULL ) ;
# endif
// Acquire IO memory for vendorreq
# ifdef CONFIG_USB_VENDOR_REQ_BUFFER_PREALLOC
pIo_buf = pdvobjpriv - > usb_vendor_req_buf ;
# else
# ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE
tmp_buf = rtw_malloc ( ( u32 ) len + ALIGNMENT_UNIT ) ;
tmp_buflen = ( u32 ) len + ALIGNMENT_UNIT ;
# else // use stack memory
tmp_buflen = MAX_USB_IO_CTL_SIZE ;
# endif
// Added by Albert 2010/02/09
// For mstar platform, mstar suggests the address for USB IO should be 16 bytes alignment.
// Trying to fix it here.
pIo_buf = ( tmp_buf = = NULL ) ? NULL : tmp_buf + ALIGNMENT_UNIT - ( ( SIZE_PTR ) ( tmp_buf ) & 0x0f ) ;
# endif
if ( pIo_buf = = NULL ) {
2013-05-09 16:23:32 +00:00
DBG_8192C ( " [%s] pIo_buf == NULL \n " , __func__ ) ;
2013-05-08 21:45:39 +00:00
status = - ENOMEM ;
goto release_mutex ;
}
2013-05-09 04:04:25 +00:00
while ( + + vendorreq_times < = MAX_USBCTRL_VENDORREQ_TIMES )
2013-05-08 21:45:39 +00:00
{
_rtw_memset ( pIo_buf , 0 , len ) ;
if ( requesttype = = 0x01 )
{
pipe = usb_rcvctrlpipe ( udev , 0 ) ; //read_in
reqtype = REALTEK_USB_VENQT_READ ;
}
else
{
pipe = usb_sndctrlpipe ( udev , 0 ) ; //write_out
reqtype = REALTEK_USB_VENQT_WRITE ;
_rtw_memcpy ( pIo_buf , pdata , len ) ;
}
#if 0
//timeout test for firmware downloading
status = rtw_usb_control_msg ( udev , pipe , request , reqtype , value , index , pIo_buf , len
, ( value = = FW_8188E_START_ADDRESS ) ? RTW_USB_CONTROL_MSG_TIMEOUT_TEST : RTW_USB_CONTROL_MSG_TIMEOUT
) ;
# else
status = rtw_usb_control_msg ( udev , pipe , request , reqtype , value , index , pIo_buf , len , RTW_USB_CONTROL_MSG_TIMEOUT ) ;
# endif
if ( status = = len ) // Success this control transfer.
{
rtw_reset_continual_urb_error ( pdvobjpriv ) ;
if ( requesttype = = 0x01 )
{ // For Control read transfer, we have to copy the read data from pIo_buf to pdata.
_rtw_memcpy ( pdata , pIo_buf , len ) ;
}
}
else { // error cases
DBG_8192C ( " reg 0x%x, usb %s %u fail, status:%d value=0x%x, vendorreq_times:%d \n "
, value , ( requesttype = = 0x01 ) ? " read " : " write " , len , status , * ( u32 * ) pdata , vendorreq_times ) ;
if ( status < 0 ) {
2013-05-09 04:04:25 +00:00
if ( status = = ( - ESHUTDOWN ) | | status = = - ENODEV )
2013-05-08 21:45:39 +00:00
{
padapter - > bSurpriseRemoved = _TRUE ;
} else {
# ifdef DBG_CONFIG_ERROR_DETECT
{
HAL_DATA_TYPE * pHalData = GET_HAL_DATA ( padapter ) ;
pHalData - > srestpriv . Wifi_Error_Status = USB_VEN_REQ_CMD_FAIL ;
}
# endif
}
}
else // status != len && status >= 0
{
2013-05-09 04:04:25 +00:00
if ( status > 0 ) {
2013-05-08 21:45:39 +00:00
if ( requesttype = = 0x01 )
{ // For Control read transfer, we have to copy the read data from pIo_buf to pdata.
_rtw_memcpy ( pdata , pIo_buf , len ) ;
}
}
}
2013-05-09 04:04:25 +00:00
if ( rtw_inc_and_chk_continual_urb_error ( pdvobjpriv ) = = _TRUE ) {
2013-05-08 21:45:39 +00:00
padapter - > bSurpriseRemoved = _TRUE ;
break ;
}
}
// firmware download is checksumed, don't retry
2013-05-09 04:04:25 +00:00
if ( ( value > = FW_8188E_START_ADDRESS & & value < = FW_8188E_END_ADDRESS ) | | status = = len )
2013-05-08 21:45:39 +00:00
break ;
}
// release IO memory used by vendorreq
# ifdef CONFIG_USB_VENDOR_REQ_BUFFER_DYNAMIC_ALLOCATE
rtw_mfree ( tmp_buf , tmp_buflen ) ;
# endif
release_mutex :
# ifdef CONFIG_USB_VENDOR_REQ_MUTEX
_exit_critical_mutex ( & pdvobjpriv - > usb_vendor_req_mutex , NULL ) ;
# endif
exit :
return status ;
}
static u8 usb_read8 ( struct intf_hdl * pintfhdl , u32 addr )
{
u8 request ;
u8 requesttype ;
u16 wvalue ;
u16 index ;
u16 len ;
u8 data = 0 ;
_func_enter_ ;
request = 0x05 ;
requesttype = 0x01 ; //read_in
index = 0 ; //n/a
wvalue = ( u16 ) ( addr & 0x0000ffff ) ;
len = 1 ;
usbctrl_vendorreq ( pintfhdl , request , wvalue , index , & data , len , requesttype ) ;
_func_exit_ ;
return data ;
}
static u16 usb_read16 ( struct intf_hdl * pintfhdl , u32 addr )
{
u8 request ;
u8 requesttype ;
u16 wvalue ;
u16 index ;
u16 len ;
u16 data = 0 ;
_func_enter_ ;
request = 0x05 ;
requesttype = 0x01 ; //read_in
index = 0 ; //n/a
wvalue = ( u16 ) ( addr & 0x0000ffff ) ;
len = 2 ;
usbctrl_vendorreq ( pintfhdl , request , wvalue , index , & data , len , requesttype ) ;
_func_exit_ ;
return data ;
}
static u32 usb_read32 ( struct intf_hdl * pintfhdl , u32 addr )
{
u8 request ;
u8 requesttype ;
u16 wvalue ;
u16 index ;
u16 len ;
u32 data = 0 ;
_func_enter_ ;
request = 0x05 ;
requesttype = 0x01 ; //read_in
index = 0 ; //n/a
wvalue = ( u16 ) ( addr & 0x0000ffff ) ;
len = 4 ;
usbctrl_vendorreq ( pintfhdl , request , wvalue , index , & data , len , requesttype ) ;
_func_exit_ ;
return data ;
}
static int usb_write8 ( struct intf_hdl * pintfhdl , u32 addr , u8 val )
{
u8 request ;
u8 requesttype ;
u16 wvalue ;
u16 index ;
u16 len ;
u8 data ;
int ret ;
_func_enter_ ;
request = 0x05 ;
requesttype = 0x00 ; //write_out
index = 0 ; //n/a
wvalue = ( u16 ) ( addr & 0x0000ffff ) ;
len = 1 ;
data = val ;
ret = usbctrl_vendorreq ( pintfhdl , request , wvalue , index , & data , len , requesttype ) ;
_func_exit_ ;
return ret ;
}
static int usb_write16 ( struct intf_hdl * pintfhdl , u32 addr , u16 val )
{
u8 request ;
u8 requesttype ;
u16 wvalue ;
u16 index ;
u16 len ;
u16 data ;
int ret ;
_func_enter_ ;
request = 0x05 ;
requesttype = 0x00 ; //write_out
index = 0 ; //n/a
wvalue = ( u16 ) ( addr & 0x0000ffff ) ;
len = 2 ;
data = val ;
ret = usbctrl_vendorreq ( pintfhdl , request , wvalue , index , & data , len , requesttype ) ;
_func_exit_ ;
return ret ;
}
static int usb_write32 ( struct intf_hdl * pintfhdl , u32 addr , u32 val )
{
u8 request ;
u8 requesttype ;
u16 wvalue ;
u16 index ;
u16 len ;
u32 data ;
int ret ;
_func_enter_ ;
request = 0x05 ;
requesttype = 0x00 ; //write_out
index = 0 ; //n/a
wvalue = ( u16 ) ( addr & 0x0000ffff ) ;
len = 4 ;
data = val ;
ret = usbctrl_vendorreq ( pintfhdl , request , wvalue , index , & data , len , requesttype ) ;
_func_exit_ ;
return ret ;
}
static int usb_writeN ( struct intf_hdl * pintfhdl , u32 addr , u32 length , u8 * pdata )
{
u8 request ;
u8 requesttype ;
u16 wvalue ;
u16 index ;
u16 len ;
u8 buf [ VENDOR_CMD_MAX_DATA_LEN ] = { 0 } ;
int ret ;
_func_enter_ ;
request = 0x05 ;
requesttype = 0x00 ; //write_out
index = 0 ; //n/a
wvalue = ( u16 ) ( addr & 0x0000ffff ) ;
len = length ;
_rtw_memcpy ( buf , pdata , len ) ;
ret = usbctrl_vendorreq ( pintfhdl , request , wvalue , index , buf , len , requesttype ) ;
_func_exit_ ;
return ret ;
}
# ifdef CONFIG_SUPPORT_USB_INT
void interrupt_handler_8188eu ( _adapter * padapter , u16 pkt_len , u8 * pbuf )
{
HAL_DATA_TYPE * pHalData = GET_HAL_DATA ( padapter ) ;
struct reportpwrstate_parm pwr_rpt ;
if ( pkt_len ! = INTERRUPT_MSG_FORMAT_LEN )
{
2013-05-09 16:23:32 +00:00
DBG_8192C ( " %s Invalid interrupt content length (%d)! \n " , __func__ , pkt_len ) ;
2013-05-08 21:45:39 +00:00
return ;
}
// HISR
_rtw_memcpy ( & ( pHalData - > IntArray [ 0 ] ) , & ( pbuf [ USB_INTR_CONTENT_HISR_OFFSET ] ) , 4 ) ;
_rtw_memcpy ( & ( pHalData - > IntArray [ 1 ] ) , & ( pbuf [ USB_INTR_CONTENT_HISRE_OFFSET ] ) , 4 ) ;
#if 0 //DBG
{
u32 hisr = 0 , hisr_ex = 0 ;
_rtw_memcpy ( & hisr , & ( pHalData - > IntArray [ 0 ] ) , 4 ) ;
hisr = le32_to_cpu ( hisr ) ;
_rtw_memcpy ( & hisr_ex , & ( pHalData - > IntArray [ 1 ] ) , 4 ) ;
hisr_ex = le32_to_cpu ( hisr_ex ) ;
2013-05-09 04:04:25 +00:00
if ( ( hisr ! = 0 ) | | ( hisr_ex ! = 0 ) )
2013-05-09 16:23:32 +00:00
DBG_871X ( " ===> %s hisr:0x%08x ,hisr_ex:0x%08x \n " , __func__ , hisr , hisr_ex ) ;
2013-05-08 21:45:39 +00:00
}
# endif
# ifdef CONFIG_LPS_LCLK
2013-05-09 04:04:25 +00:00
if ( pHalData - > IntArray [ 0 ] & IMR_CPWM_88E )
2013-05-08 21:45:39 +00:00
{
_rtw_memcpy ( & pwr_rpt . state , & ( pbuf [ USB_INTR_CONTENT_CPWM1_OFFSET ] ) , 1 ) ;
//_rtw_memcpy(&pwr_rpt.state2, &(pbuf[USB_INTR_CONTENT_CPWM2_OFFSET]), 1);
//88e's cpwm value only change BIT0, so driver need to add PS_STATE_S2 for LPS flow.
pwr_rpt . state | = PS_STATE_S2 ;
_set_workitem ( & padapter - > pwrctrlpriv . cpwm_event ) ;
}
# endif //CONFIG_LPS_LCLK
# ifdef CONFIG_INTERRUPT_BASED_TXBCN
# ifdef CONFIG_INTERRUPT_BASED_TXBCN_EARLY_INT
if ( pHalData - > IntArray [ 0 ] & IMR_BCNDMAINT0_88E )
# endif
# ifdef CONFIG_INTERRUPT_BASED_TXBCN_BCN_OK_ERR
if ( pHalData - > IntArray [ 0 ] & ( IMR_TBDER_88E | IMR_TBDOK_88E ) )
# endif
{
struct mlme_priv * pmlmepriv = & padapter - > mlmepriv ;
#if 0
2013-05-09 04:04:25 +00:00
if ( pHalData - > IntArray [ 0 ] & IMR_BCNDMAINT0_88E )
2013-05-08 21:45:39 +00:00
DBG_8192C ( " %s: HISR_BCNERLY_INT \n " , __func__ ) ;
2013-05-09 04:04:25 +00:00
if ( pHalData - > IntArray [ 0 ] & IMR_TBDOK_88E )
2013-05-08 21:45:39 +00:00
DBG_8192C ( " %s: HISR_TXBCNOK \n " , __func__ ) ;
2013-05-09 04:04:25 +00:00
if ( pHalData - > IntArray [ 0 ] & IMR_TBDER_88E )
2013-05-08 21:45:39 +00:00
DBG_8192C ( " %s: HISR_TXBCNERR \n " , __func__ ) ;
# endif
2013-05-09 04:04:25 +00:00
if ( check_fwstate ( pmlmepriv , WIFI_AP_STATE ) )
2013-05-08 21:45:39 +00:00
{
//send_beacon(padapter);
2013-05-09 04:04:25 +00:00
if ( pmlmepriv - > update_bcn = = _TRUE )
2013-05-08 21:45:39 +00:00
{
//tx_beacon_hdl(padapter, NULL);
set_tx_beacon_cmd ( padapter ) ;
}
}
# ifdef CONFIG_CONCURRENT_MODE
2013-05-09 04:04:25 +00:00
if ( check_buddy_fwstate ( padapter , WIFI_AP_STATE ) )
2013-05-08 21:45:39 +00:00
{
//send_beacon(padapter);
2013-05-09 04:04:25 +00:00
if ( padapter - > pbuddy_adapter - > mlmepriv . update_bcn = = _TRUE )
2013-05-08 21:45:39 +00:00
{
//tx_beacon_hdl(padapter, NULL);
set_tx_beacon_cmd ( padapter - > pbuddy_adapter ) ;
}
}
# endif
}
# endif //CONFIG_INTERRUPT_BASED_TXBCN
# ifdef DBG_CONFIG_ERROR_DETECT_INT
2013-05-09 04:04:25 +00:00
if ( pHalData - > IntArray [ 1 ] & IMR_TXERR_88E )
2013-05-09 16:23:32 +00:00
DBG_871X ( " ===> %s Tx Error Flag Interrupt Status \n " , __func__ ) ;
2013-05-09 04:04:25 +00:00
if ( pHalData - > IntArray [ 1 ] & IMR_RXERR_88E )
2013-05-09 16:23:32 +00:00
DBG_871X ( " ===> %s Rx Error Flag INT Status \n " , __func__ ) ;
2013-05-09 04:04:25 +00:00
if ( pHalData - > IntArray [ 1 ] & IMR_TXFOVW_88E )
2013-05-09 16:23:32 +00:00
DBG_871X ( " ===> %s Transmit FIFO Overflow \n " , __func__ ) ;
2013-05-09 04:04:25 +00:00
if ( pHalData - > IntArray [ 1 ] & IMR_RXFOVW_88E )
2013-05-09 16:23:32 +00:00
DBG_871X ( " ===> %s Receive FIFO Overflow \n " , __func__ ) ;
2013-05-08 21:45:39 +00:00
# endif //DBG_CONFIG_ERROR_DETECT_INT
// C2H Event
2013-05-09 04:04:25 +00:00
if ( pbuf [ 0 ] ! = 0 ) {
2013-05-08 21:45:39 +00:00
_rtw_memcpy ( & ( pHalData - > C2hArray [ 0 ] ) , & ( pbuf [ USB_INTR_CONTENT_C2H_OFFSET ] ) , 16 ) ;
//rtw_c2h_wk_cmd(padapter); to do..
}
}
# endif
# ifdef CONFIG_USB_INTERRUPT_IN_PIPE
static void usb_read_interrupt_complete ( struct urb * purb , struct pt_regs * regs )
{
int err ;
_adapter * padapter = ( _adapter * ) purb - > context ;
2013-05-09 04:04:25 +00:00
if ( padapter - > bSurpriseRemoved | | padapter - > bDriverStopped | | padapter - > bReadPortCancel )
2013-05-08 21:45:39 +00:00
{
DBG_8192C ( " %s() RX Warning! bDriverStopped(%d) OR bSurpriseRemoved(%d) bReadPortCancel(%d) \n " ,
2013-05-09 16:23:32 +00:00
__func__ , padapter - > bDriverStopped , padapter - > bSurpriseRemoved , padapter - > bReadPortCancel ) ;
2013-05-08 21:45:39 +00:00
return ;
}
2013-05-09 04:04:25 +00:00
if ( purb - > status = = 0 ) //SUCCESS
2013-05-08 21:45:39 +00:00
{
if ( purb - > actual_length > INTERRUPT_MSG_FORMAT_LEN )
{
DBG_8192C ( " usb_read_interrupt_complete: purb->actual_length > INTERRUPT_MSG_FORMAT_LEN(%d) \n " , INTERRUPT_MSG_FORMAT_LEN ) ;
}
interrupt_handler_8188eu ( padapter , purb - > actual_length , purb - > transfer_buffer ) ;
err = usb_submit_urb ( purb , GFP_ATOMIC ) ;
2013-05-09 04:04:25 +00:00
if ( ( err ) & & ( err ! = ( - EPERM ) ) )
2013-05-08 21:45:39 +00:00
{
DBG_8192C ( " cannot submit interrupt in-token(err = 0x%08x),urb_status = %d \n " , err , purb - > status ) ;
}
}
else
{
DBG_8192C ( " ###=> usb_read_interrupt_complete => urb status(%d) \n " , purb - > status ) ;
2013-05-09 04:04:25 +00:00
switch ( purb - > status ) {
2013-05-08 21:45:39 +00:00
case - EINVAL :
case - EPIPE :
case - ENODEV :
case - ESHUTDOWN :
//padapter->bSurpriseRemoved=_TRUE;
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete:bSurpriseRemoved=TRUE \n " ) ) ;
case - ENOENT :
padapter - > bDriverStopped = _TRUE ;
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete:bDriverStopped=TRUE \n " ) ) ;
break ;
case - EPROTO :
break ;
case - EINPROGRESS :
DBG_8192C ( " ERROR: URB IS IN PROGRESS!/n " ) ;
break ;
default :
break ;
}
}
}
static u32 usb_read_interrupt ( struct intf_hdl * pintfhdl , u32 addr )
{
int err ;
unsigned int pipe ;
u32 ret = _SUCCESS ;
_adapter * adapter = pintfhdl - > padapter ;
struct dvobj_priv * pdvobj = adapter_to_dvobj ( adapter ) ;
struct recv_priv * precvpriv = & adapter - > recvpriv ;
struct usb_device * pusbd = pdvobj - > pusbdev ;
_func_enter_ ;
//translate DMA FIFO addr to pipehandle
pipe = ffaddr2pipehdl ( pdvobj , addr ) ;
usb_fill_int_urb ( precvpriv - > int_in_urb , pusbd , pipe ,
precvpriv - > int_in_buf ,
INTERRUPT_MSG_FORMAT_LEN ,
usb_read_interrupt_complete ,
adapter ,
1 ) ;
err = usb_submit_urb ( precvpriv - > int_in_urb , GFP_ATOMIC ) ;
2013-05-09 04:04:25 +00:00
if ( ( err ) & & ( err ! = ( - EPERM ) ) )
2013-05-08 21:45:39 +00:00
{
DBG_8192C ( " cannot submit interrupt in-token(err = 0x%08x),urb_status = %d \n " , err , precvpriv - > int_in_urb - > status ) ;
ret = _FAIL ;
}
_func_exit_ ;
return ret ;
}
# endif
static s32 pre_recv_entry ( union recv_frame * precvframe , struct recv_stat * prxstat , struct phy_stat * pphy_status )
{
s32 ret = _SUCCESS ;
# ifdef CONFIG_CONCURRENT_MODE
u8 * primary_myid , * secondary_myid , * paddr1 ;
union recv_frame * precvframe_if2 = NULL ;
_adapter * primary_padapter = precvframe - > u . hdr . adapter ;
_adapter * secondary_padapter = primary_padapter - > pbuddy_adapter ;
struct recv_priv * precvpriv = & primary_padapter - > recvpriv ;
_queue * pfree_recv_queue = & precvpriv - > free_recv_queue ;
u8 * pbuf = precvframe - > u . hdr . rx_data ;
2013-05-09 04:04:25 +00:00
if ( ! secondary_padapter )
2013-05-08 21:45:39 +00:00
return ret ;
paddr1 = GetAddr1Ptr ( precvframe - > u . hdr . rx_data ) ;
2013-05-09 04:04:25 +00:00
if ( IS_MCAST ( paddr1 ) = = _FALSE ) //unicast packets
2013-05-08 21:45:39 +00:00
{
//primary_myid = myid(&primary_padapter->eeprompriv);
secondary_myid = myid ( & secondary_padapter - > eeprompriv ) ;
2013-05-09 04:04:25 +00:00
if ( _rtw_memcmp ( paddr1 , secondary_myid , ETH_ALEN ) )
2013-05-08 21:45:39 +00:00
{
//change to secondary interface
precvframe - > u . hdr . adapter = secondary_padapter ;
}
//ret = recv_entry(precvframe);
}
else // Handle BC/MC Packets
{
u8 clone = _TRUE ;
#if 0
u8 type , subtype , * paddr2 , * paddr3 ;
type = GetFrameType ( pbuf ) ;
subtype = GetFrameSubType ( pbuf ) ; //bit(7)~bit(2)
switch ( type )
{
case WIFI_MGT_TYPE : //Handle BC/MC mgnt Packets
2013-05-09 04:04:25 +00:00
if ( subtype = = WIFI_BEACON )
2013-05-08 21:45:39 +00:00
{
paddr3 = GetAddr3Ptr ( precvframe - > u . hdr . rx_data ) ;
if ( check_fwstate ( & secondary_padapter - > mlmepriv , _FW_LINKED ) & &
_rtw_memcmp ( paddr3 , get_bssid ( & secondary_padapter - > mlmepriv ) , ETH_ALEN ) )
{
//change to secondary interface
precvframe - > u . hdr . adapter = secondary_padapter ;
clone = _FALSE ;
}
2013-05-09 04:04:25 +00:00
if ( check_fwstate ( & primary_padapter - > mlmepriv , _FW_LINKED ) & &
2013-05-08 21:45:39 +00:00
_rtw_memcmp ( paddr3 , get_bssid ( & primary_padapter - > mlmepriv ) , ETH_ALEN ) )
{
2013-05-09 04:04:25 +00:00
if ( clone = = _FALSE )
2013-05-08 21:45:39 +00:00
{
clone = _TRUE ;
}
else
{
clone = _FALSE ;
}
precvframe - > u . hdr . adapter = primary_padapter ;
}
2013-05-09 04:04:25 +00:00
if ( check_fwstate ( & primary_padapter - > mlmepriv , _FW_UNDER_SURVEY | _FW_UNDER_LINKING ) | |
2013-05-08 21:45:39 +00:00
check_fwstate ( & secondary_padapter - > mlmepriv , _FW_UNDER_SURVEY | _FW_UNDER_LINKING ) )
{
clone = _TRUE ;
precvframe - > u . hdr . adapter = primary_padapter ;
}
}
2013-05-09 04:04:25 +00:00
else if ( subtype = = WIFI_PROBEREQ )
2013-05-08 21:45:39 +00:00
{
//probe req frame is only for interface2
//change to secondary interface
precvframe - > u . hdr . adapter = secondary_padapter ;
clone = _FALSE ;
}
break ;
case WIFI_CTRL_TYPE : // Handle BC/MC ctrl Packets
break ;
case WIFI_DATA_TYPE : //Handle BC/MC data Packets
//Notes: AP MODE never rx BC/MC data packets
paddr2 = GetAddr2Ptr ( precvframe - > u . hdr . rx_data ) ;
2013-05-09 04:04:25 +00:00
if ( _rtw_memcmp ( paddr2 , get_bssid ( & secondary_padapter - > mlmepriv ) , ETH_ALEN ) )
2013-05-08 21:45:39 +00:00
{
//change to secondary interface
precvframe - > u . hdr . adapter = secondary_padapter ;
clone = _FALSE ;
}
break ;
default :
break ;
}
# endif
2013-05-09 04:04:25 +00:00
if ( _TRUE = = clone )
2013-05-08 21:45:39 +00:00
{
//clone/copy to if2
u8 shift_sz = 0 ;
u32 alloc_sz , skb_len ;
_pkt * pkt_copy = NULL ;
struct rx_pkt_attrib * pattrib = NULL ;
precvframe_if2 = rtw_alloc_recvframe ( pfree_recv_queue ) ;
2013-05-09 04:04:25 +00:00
if ( precvframe_if2 )
2013-05-08 21:45:39 +00:00
{
precvframe_if2 - > u . hdr . adapter = secondary_padapter ;
_rtw_init_listhead ( & precvframe_if2 - > u . hdr . list ) ;
precvframe_if2 - > u . hdr . precvbuf = NULL ; //can't access the precvbuf for new arch.
precvframe_if2 - > u . hdr . len = 0 ;
_rtw_memcpy ( & precvframe_if2 - > u . hdr . attrib , & precvframe - > u . hdr . attrib , sizeof ( struct rx_pkt_attrib ) ) ;
pattrib = & precvframe_if2 - > u . hdr . attrib ;
// Modified by Albert 20101213
// For 8 bytes IP header alignment.
if ( pattrib - > qos ) // Qos data, wireless lan header length is 26
{
shift_sz = 6 ;
}
else
{
shift_sz = 0 ;
}
skb_len = pattrib - > pkt_len ;
// for first fragment packet, driver need allocate 1536+drvinfo_sz+RXDESC_SIZE to defrag packet.
// modify alloc_sz for recvive crc error packet by thomas 2011-06-02
2013-05-09 04:04:25 +00:00
if ( ( pattrib - > mfrag = = 1 ) & & ( pattrib - > frag_num = = 0 ) ) {
2013-05-08 21:45:39 +00:00
//alloc_sz = 1664; //1664 is 128 alignment.
2013-05-09 04:04:25 +00:00
if ( skb_len < = 1650 )
2013-05-08 21:45:39 +00:00
alloc_sz = 1664 ;
else
alloc_sz = skb_len + 14 ;
}
else {
alloc_sz = skb_len ;
// 6 is for IP header 8 bytes alignment in QoS packet case.
// 8 is for skb->data 4 bytes alignment.
alloc_sz + = 14 ;
}
# if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html
pkt_copy = dev_alloc_skb ( alloc_sz ) ;
# else
pkt_copy = netdev_alloc_skb ( secondary_padapter - > pnetdev , alloc_sz ) ;
# endif
2013-05-09 04:04:25 +00:00
if ( pkt_copy )
2013-05-08 21:45:39 +00:00
{
pkt_copy - > dev = secondary_padapter - > pnetdev ;
precvframe_if2 - > u . hdr . pkt = pkt_copy ;
precvframe_if2 - > u . hdr . rx_head = pkt_copy - > data ;
precvframe_if2 - > u . hdr . rx_end = pkt_copy - > data + alloc_sz ;
skb_reserve ( pkt_copy , 8 - ( ( SIZE_PTR ) ( pkt_copy - > data ) & 7 ) ) ; //force pkt_copy->data at 8-byte alignment address
skb_reserve ( pkt_copy , shift_sz ) ; //force ip_hdr at 8-byte alignment address according to shift_sz.
_rtw_memcpy ( pkt_copy - > data , pbuf , skb_len ) ;
precvframe_if2 - > u . hdr . rx_data = precvframe_if2 - > u . hdr . rx_tail = pkt_copy - > data ;
recvframe_put ( precvframe_if2 , skb_len ) ;
if ( pattrib - > physt )
update_recvframe_phyinfo_88e ( precvframe_if2 , ( struct phy_stat * ) pphy_status ) ;
ret = rtw_recv_entry ( precvframe_if2 ) ;
}
else {
rtw_free_recvframe ( precvframe_if2 , pfree_recv_queue ) ;
2013-05-09 16:23:32 +00:00
DBG_8192C ( " %s()-%d: alloc_skb() failed! \n " , __func__ , __LINE__ ) ;
2013-05-08 21:45:39 +00:00
}
}
}
}
if ( precvframe - > u . hdr . attrib . physt )
update_recvframe_phyinfo_88e ( precvframe , ( struct phy_stat * ) pphy_status ) ;
ret = rtw_recv_entry ( precvframe ) ;
# endif
return ret ;
}
# ifdef CONFIG_USE_USB_BUFFER_ALLOC_RX
static int recvbuf2recvframe ( _adapter * padapter , struct recv_buf * precvbuf )
{
u8 * pbuf ;
u8 shift_sz = 0 ;
u16 pkt_cnt , drvinfo_sz ;
u32 pkt_offset , skb_len , alloc_sz ;
s32 transfer_len ;
struct recv_stat * prxstat ;
struct phy_stat * pphy_status = NULL ;
_pkt * pkt_copy = NULL ;
union recv_frame * precvframe = NULL ;
struct rx_pkt_attrib * pattrib = NULL ;
HAL_DATA_TYPE * pHalData = GET_HAL_DATA ( padapter ) ;
struct recv_priv * precvpriv = & padapter - > recvpriv ;
_queue * pfree_recv_queue = & precvpriv - > free_recv_queue ;
transfer_len = ( s32 ) precvbuf - > transfer_len ;
pbuf = precvbuf - > pbuf ;
prxstat = ( struct recv_stat * ) pbuf ;
pkt_cnt = ( le32_to_cpu ( prxstat - > rxdw2 ) > > 16 ) & 0xff ;
#if 0 //temp remove when disable usb rx aggregation
2013-05-09 04:04:25 +00:00
if ( ( pkt_cnt > 10 ) | | ( pkt_cnt < 1 ) | | ( transfer_len < RXDESC_SIZE ) | | ( pkt_len < = 0 ) )
2013-05-08 21:45:39 +00:00
{
return _FAIL ;
}
# endif
do {
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_info_ ,
( " recvbuf2recvframe: rxdesc=offsset 0:0x%08x, 4:0x%08x, 8:0x%08x, C:0x%08x \n " ,
prxstat - > rxdw0 , prxstat - > rxdw1 , prxstat - > rxdw2 , prxstat - > rxdw4 ) ) ;
prxstat = ( struct recv_stat * ) pbuf ;
precvframe = rtw_alloc_recvframe ( pfree_recv_queue ) ;
2013-05-09 04:04:25 +00:00
if ( precvframe = = NULL )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_err_ , ( " recvbuf2recvframe: precvframe==NULL \n " ) ) ;
2013-05-09 16:23:32 +00:00
DBG_8192C ( " %s()-%d: rtw_alloc_recvframe() failed! RX Drop! \n " , __func__ , __LINE__ ) ;
2013-05-08 21:45:39 +00:00
goto _exit_recvbuf2recvframe ;
}
_rtw_init_listhead ( & precvframe - > u . hdr . list ) ;
precvframe - > u . hdr . precvbuf = NULL ; //can't access the precvbuf for new arch.
precvframe - > u . hdr . len = 0 ;
//rtl8192c_query_rx_desc_status(precvframe, prxstat);
update_recvframe_attrib_88e ( precvframe , prxstat ) ;
pattrib = & precvframe - > u . hdr . attrib ;
# ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV
2013-05-09 04:04:25 +00:00
//if (pattrib->pkt_len>2000){
2013-05-09 16:23:32 +00:00
// printk("%s: RX Warning!pkt_len= %d, data rate=0x%02x\n", __func__,pattrib->pkt_len,pattrib->mcs_rate);
2013-05-08 21:45:39 +00:00
//}
# endif
if ( ( pattrib - > crc_err ) | | ( pattrib - > icv_err ) )
{
2013-05-09 04:04:25 +00:00
if ( pattrib - > pkt_len > 2000 ) {
2013-05-09 16:23:32 +00:00
DBG_8192C ( " %s: RX Warning! crc_err=%d icv_err=%d, skip! \n " , __func__ , pattrib - > crc_err , pattrib - > icv_err ) ;
2013-05-08 21:45:39 +00:00
# ifdef CONFIG_SPECIAL_SETTING_FOR_FUNAI_TV
2013-05-09 16:23:32 +00:00
printk ( " %s: RX Warning!pkt_len= %d, data rate=0x%02x \n " , __func__ , pattrib - > pkt_len , pattrib - > mcs_rate ) ;
2013-05-08 21:45:39 +00:00
# endif
}
rtw_free_recvframe ( precvframe , pfree_recv_queue ) ;
goto _exit_recvbuf2recvframe ;
}
2013-05-09 04:04:25 +00:00
if ( ( pattrib - > physt ) & & ( pattrib - > pkt_rpt_type = = NORMAL_RX ) )
2013-05-08 21:45:39 +00:00
{
pphy_status = ( struct phy_stat * ) ( pbuf + RXDESC_OFFSET ) ;
}
pkt_offset = RXDESC_SIZE + pattrib - > drvinfo_sz + pattrib - > shift_sz + pattrib - > pkt_len ;
2013-05-09 04:04:25 +00:00
if ( ( pattrib - > pkt_len < = 0 ) | | ( pkt_offset > transfer_len ) )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_info_ , ( " recvbuf2recvframe: pkt_len<=0 \n " ) ) ;
2013-05-09 16:23:32 +00:00
DBG_8192C ( " %s()-%d: RX Warning! \n " , __func__ , __LINE__ ) ;
2013-05-08 21:45:39 +00:00
rtw_free_recvframe ( precvframe , pfree_recv_queue ) ;
goto _exit_recvbuf2recvframe ;
}
// Modified by Albert 20101213
// For 8 bytes IP header alignment.
if ( pattrib - > qos ) // Qos data, wireless lan header length is 26
{
shift_sz = 6 ;
}
else
{
shift_sz = 0 ;
}
skb_len = pattrib - > pkt_len ;
// for first fragment packet, driver need allocate 1536+drvinfo_sz+RXDESC_SIZE to defrag packet.
// modify alloc_sz for recvive crc error packet by thomas 2011-06-02
2013-05-09 04:04:25 +00:00
if ( ( pattrib - > mfrag = = 1 ) & & ( pattrib - > frag_num = = 0 ) ) {
2013-05-08 21:45:39 +00:00
//alloc_sz = 1664; //1664 is 128 alignment.
2013-05-09 04:04:25 +00:00
if ( skb_len < = 1650 )
2013-05-08 21:45:39 +00:00
alloc_sz = 1664 ;
else
alloc_sz = skb_len + 14 ;
}
else {
alloc_sz = skb_len ;
// 6 is for IP header 8 bytes alignment in QoS packet case.
// 8 is for skb->data 4 bytes alignment.
alloc_sz + = 14 ;
}
# if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html
pkt_copy = dev_alloc_skb ( alloc_sz ) ;
# else
pkt_copy = netdev_alloc_skb ( padapter - > pnetdev , alloc_sz ) ;
# endif
2013-05-09 04:04:25 +00:00
if ( pkt_copy )
2013-05-08 21:45:39 +00:00
{
pkt_copy - > dev = padapter - > pnetdev ;
precvframe - > u . hdr . pkt = pkt_copy ;
precvframe - > u . hdr . rx_head = pkt_copy - > data ;
precvframe - > u . hdr . rx_end = pkt_copy - > data + alloc_sz ;
skb_reserve ( pkt_copy , 8 - ( ( SIZE_PTR ) ( pkt_copy - > data ) & 7 ) ) ; //force pkt_copy->data at 8-byte alignment address
skb_reserve ( pkt_copy , shift_sz ) ; //force ip_hdr at 8-byte alignment address according to shift_sz.
_rtw_memcpy ( pkt_copy - > data , ( pbuf + pattrib - > drvinfo_sz + RXDESC_SIZE ) , skb_len ) ;
precvframe - > u . hdr . rx_data = precvframe - > u . hdr . rx_tail = pkt_copy - > data ;
}
else
{
DBG_8192C ( " recvbuf2recvframe:can not allocate memory for skb copy \n " ) ;
//precvframe->u.hdr.pkt = skb_clone(pskb, GFP_ATOMIC);
//precvframe->u.hdr.rx_head = precvframe->u.hdr.rx_data = precvframe->u.hdr.rx_tail = pbuf;
//precvframe->u.hdr.rx_end = pbuf + (pkt_offset>1612?pkt_offset:1612);
precvframe - > u . hdr . pkt = NULL ;
rtw_free_recvframe ( precvframe , pfree_recv_queue ) ;
goto _exit_recvbuf2recvframe ;
}
recvframe_put ( precvframe , skb_len ) ;
//recvframe_pull(precvframe, drvinfo_sz + RXDESC_SIZE);
# ifdef CONFIG_USB_RX_AGGREGATION
2013-05-09 04:04:25 +00:00
switch ( pHalData - > UsbRxAggMode )
2013-05-08 21:45:39 +00:00
{
case USB_RX_AGG_DMA :
case USB_RX_AGG_MIX :
pkt_offset = ( u16 ) _RND128 ( pkt_offset ) ;
break ;
case USB_RX_AGG_USB :
pkt_offset = ( u16 ) _RND4 ( pkt_offset ) ;
break ;
case USB_RX_AGG_DISABLE :
default :
break ;
}
# endif
2013-05-09 04:04:25 +00:00
if ( pattrib - > pkt_rpt_type = = NORMAL_RX ) //Normal rx packet
2013-05-08 21:45:39 +00:00
{
# ifdef CONFIG_CONCURRENT_MODE
2013-05-09 04:04:25 +00:00
if ( rtw_buddy_adapter_up ( padapter ) )
2013-05-08 21:45:39 +00:00
{
2013-05-09 04:04:25 +00:00
if ( pre_recv_entry ( precvframe , prxstat , pphy_status ) ! = _SUCCESS )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_err_ ,
( " recvbuf2recvframe: recv_entry(precvframe) != _SUCCESS \n " ) ) ;
}
}
else
# endif
{
if ( pattrib - > physt )
update_recvframe_phyinfo_88e ( precvframe , ( struct phy_stat * ) pphy_status ) ;
2013-05-09 04:04:25 +00:00
if ( rtw_recv_entry ( precvframe ) ! = _SUCCESS )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_err_ ,
( " recvbuf2recvframe: rtw_recv_entry(precvframe) != _SUCCESS \n " ) ) ;
}
}
}
else { // pkt_rpt_type == TX_REPORT1-CCX, TX_REPORT2-TX RTP,HIS_REPORT-USB HISR RTP
//enqueue recvframe to txrtp queue
2013-05-09 04:04:25 +00:00
if ( pattrib - > pkt_rpt_type = = TX_REPORT1 ) {
2013-05-09 04:09:18 +00:00
//DBG_8192C("rx CCX\n");
2013-05-08 21:45:39 +00:00
//CCX-TXRPT ack for xmit mgmt frames.
handle_txrpt_ccx_88e ( padapter , precvframe - > u . hdr . rx_data ) ;
}
2013-05-09 04:04:25 +00:00
else if ( pattrib - > pkt_rpt_type = = TX_REPORT2 ) {
2013-05-09 04:09:18 +00:00
//DBG_8192C("rx TX RPT\n");
2013-05-08 21:45:39 +00:00
ODM_RA_TxRPT2Handle_8188E (
& pHalData - > odmpriv ,
precvframe - > u . hdr . rx_data ,
pattrib - > pkt_len ,
pattrib - > MacIDValidEntry [ 0 ] ,
pattrib - > MacIDValidEntry [ 1 ]
) ;
}
2013-05-09 04:04:25 +00:00
else if ( pattrib - > pkt_rpt_type = = HIS_REPORT )
2013-05-08 21:45:39 +00:00
{
2013-05-09 16:23:32 +00:00
//DBG_8192C("%s , rx USB HISR\n",__func__);
2013-05-08 21:45:39 +00:00
# ifdef CONFIG_SUPPORT_USB_INT
interrupt_handler_8188eu ( padapter , pattrib - > pkt_len , precvframe - > u . hdr . rx_data ) ;
# endif
}
rtw_free_recvframe ( precvframe , pfree_recv_queue ) ;
}
pkt_cnt - - ;
transfer_len - = pkt_offset ;
pbuf + = pkt_offset ;
precvframe = NULL ;
pkt_copy = NULL ;
2013-05-09 04:04:25 +00:00
if ( transfer_len > 0 & & pkt_cnt = = 0 )
2013-05-08 21:45:39 +00:00
pkt_cnt = ( le32_to_cpu ( prxstat - > rxdw2 ) > > 16 ) & 0xff ;
2013-05-09 04:04:25 +00:00
} while ( ( transfer_len > 0 ) & & ( pkt_cnt > 0 ) ) ;
2013-05-08 21:45:39 +00:00
_exit_recvbuf2recvframe :
return _SUCCESS ;
}
void rtl8188eu_recv_tasklet ( void * priv )
{
struct recv_buf * precvbuf = NULL ;
_adapter * padapter = ( _adapter * ) priv ;
struct recv_priv * precvpriv = & padapter - > recvpriv ;
while ( NULL ! = ( precvbuf = rtw_dequeue_recvbuf ( & precvpriv - > recv_buf_pending_queue ) ) )
{
if ( ( padapter - > bDriverStopped = = _TRUE ) | | ( padapter - > bSurpriseRemoved = = _TRUE ) )
{
2013-05-09 04:09:18 +00:00
DBG_8192C ( " recv_tasklet => bDriverStopped or bSurpriseRemoved \n " ) ;
2013-05-08 21:45:39 +00:00
break ;
}
recvbuf2recvframe ( padapter , precvbuf ) ;
rtw_read_port ( padapter , precvpriv - > ff_hwaddr , 0 , ( unsigned char * ) precvbuf ) ;
}
}
static void usb_read_port_complete ( struct urb * purb , struct pt_regs * regs )
{
struct recv_buf * precvbuf = ( struct recv_buf * ) purb - > context ;
_adapter * padapter = ( _adapter * ) precvbuf - > adapter ;
struct recv_priv * precvpriv = & padapter - > recvpriv ;
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete!!! \n " ) ) ;
precvpriv - > rx_pending_cnt - - ;
2013-05-09 04:04:25 +00:00
if ( padapter - > bSurpriseRemoved | | padapter - > bDriverStopped | | padapter - > bReadPortCancel )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete:bDriverStopped(%d) OR bSurpriseRemoved(%d) \n " , padapter - > bDriverStopped , padapter - > bSurpriseRemoved ) ) ;
DBG_8192C ( " %s() RX Warning! bDriverStopped(%d) OR bSurpriseRemoved(%d) bReadPortCancel(%d) \n " ,
2013-05-09 16:23:32 +00:00
__func__ , padapter - > bDriverStopped , padapter - > bSurpriseRemoved , padapter - > bReadPortCancel ) ;
2013-05-08 21:45:39 +00:00
goto exit ;
}
2013-05-09 04:04:25 +00:00
if ( purb - > status = = 0 ) //SUCCESS
2013-05-08 21:45:39 +00:00
{
if ( ( purb - > actual_length > MAX_RECVBUF_SZ ) | | ( purb - > actual_length < RXDESC_SIZE ) )
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete: (purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE) \n " ) ) ;
rtw_read_port ( padapter , precvpriv - > ff_hwaddr , 0 , ( unsigned char * ) precvbuf ) ;
}
else
{
rtw_reset_continual_urb_error ( adapter_to_dvobj ( padapter ) ) ;
precvbuf - > transfer_len = purb - > actual_length ;
//rtw_enqueue_rx_transfer_buffer(precvpriv, rx_transfer_buf);
rtw_enqueue_recvbuf ( precvbuf , & precvpriv - > recv_buf_pending_queue ) ;
tasklet_schedule ( & precvpriv - > recv_tasklet ) ;
}
}
else
{
2013-05-09 04:09:18 +00:00
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete : purb->status(%d) != 0 \n " , purb - > status ) ) ;
2013-05-08 21:45:39 +00:00
DBG_8192C ( " ###=> usb_read_port_complete => urb status(%d) \n " , purb - > status ) ;
2013-05-09 04:04:25 +00:00
if ( rtw_inc_and_chk_continual_urb_error ( adapter_to_dvobj ( padapter ) ) = = _TRUE ) {
2013-05-08 21:45:39 +00:00
padapter - > bSurpriseRemoved = _TRUE ;
}
2013-05-09 04:04:25 +00:00
switch ( purb - > status ) {
2013-05-08 21:45:39 +00:00
case - EINVAL :
case - EPIPE :
case - ENODEV :
case - ESHUTDOWN :
//padapter->bSurpriseRemoved=_TRUE;
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete:bSurpriseRemoved=TRUE \n " ) ) ;
case - ENOENT :
padapter - > bDriverStopped = _TRUE ;
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete:bDriverStopped=TRUE \n " ) ) ;
break ;
case - EPROTO :
case - EOVERFLOW :
# ifdef DBG_CONFIG_ERROR_DETECT
{
HAL_DATA_TYPE * pHalData = GET_HAL_DATA ( padapter ) ;
pHalData - > srestpriv . Wifi_Error_Status = USB_READ_PORT_FAIL ;
}
# endif
rtw_read_port ( padapter , precvpriv - > ff_hwaddr , 0 , ( unsigned char * ) precvbuf ) ;
break ;
case - EINPROGRESS :
DBG_8192C ( " ERROR: URB IS IN PROGRESS!/n " ) ;
break ;
default :
break ;
}
}
exit :
_func_exit_ ;
}
static u32 usb_read_port ( struct intf_hdl * pintfhdl , u32 addr , u32 cnt , u8 * rmem )
{
int err ;
unsigned int pipe ;
u32 ret = _SUCCESS ;
PURB purb = NULL ;
struct recv_buf * precvbuf = ( struct recv_buf * ) rmem ;
_adapter * adapter = pintfhdl - > padapter ;
struct dvobj_priv * pdvobj = adapter_to_dvobj ( adapter ) ;
struct recv_priv * precvpriv = & adapter - > recvpriv ;
struct usb_device * pusbd = pdvobj - > pusbdev ;
_func_enter_ ;
2013-05-09 04:04:25 +00:00
if ( adapter - > bDriverStopped | | adapter - > bSurpriseRemoved | | adapter - > pwrctrlpriv . pnp_bstop_trx )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port:( padapter->bDriverStopped ||padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!! \n " ) ) ;
return _FAIL ;
}
2013-05-09 04:04:25 +00:00
if ( precvbuf ! = NULL )
2013-05-08 21:45:39 +00:00
{
rtl8188eu_init_recvbuf ( adapter , precvbuf ) ;
2013-05-09 04:04:25 +00:00
if ( precvbuf - > pbuf )
2013-05-08 21:45:39 +00:00
{
precvpriv - > rx_pending_cnt + + ;
purb = precvbuf - > purb ;
//translate DMA FIFO addr to pipehandle
pipe = ffaddr2pipehdl ( pdvobj , addr ) ;
usb_fill_bulk_urb ( purb , pusbd , pipe ,
precvbuf - > pbuf ,
MAX_RECVBUF_SZ ,
usb_read_port_complete ,
precvbuf ) ; //context is precvbuf
purb - > transfer_dma = precvbuf - > dma_transfer_addr ;
purb - > transfer_flags | = URB_NO_TRANSFER_DMA_MAP ;
err = usb_submit_urb ( purb , GFP_ATOMIC ) ;
2013-05-09 04:04:25 +00:00
if ( ( err ) & & ( err ! = ( - EPERM ) ) )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " cannot submit rx in-token(err=0x%.8x), URB_STATUS =0x%.8x " , err , purb - > status ) ) ;
DBG_8192C ( " cannot submit rx in-token(err = 0x%08x),urb_status = %d \n " , err , purb - > status ) ;
ret = _FAIL ;
}
}
}
else
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port:precvbuf ==NULL \n " ) ) ;
ret = _FAIL ;
}
_func_exit_ ;
return ret ;
}
# else // CONFIG_USE_USB_BUFFER_ALLOC_RX
static int recvbuf2recvframe ( _adapter * padapter , _pkt * pskb )
{
u8 * pbuf ;
u8 shift_sz = 0 ;
u16 pkt_cnt ;
u32 pkt_offset , skb_len , alloc_sz ;
s32 transfer_len ;
struct recv_stat * prxstat ;
struct phy_stat * pphy_status = NULL ;
_pkt * pkt_copy = NULL ;
union recv_frame * precvframe = NULL ;
struct rx_pkt_attrib * pattrib = NULL ;
HAL_DATA_TYPE * pHalData = GET_HAL_DATA ( padapter ) ;
struct recv_priv * precvpriv = & padapter - > recvpriv ;
_queue * pfree_recv_queue = & precvpriv - > free_recv_queue ;
transfer_len = ( s32 ) pskb - > len ;
pbuf = pskb - > data ;
prxstat = ( struct recv_stat * ) pbuf ;
pkt_cnt = ( le32_to_cpu ( prxstat - > rxdw2 ) > > 16 ) & 0xff ;
#if 0 //temp remove when disable usb rx aggregation
2013-05-09 04:04:25 +00:00
if ( ( pkt_cnt > 10 ) | | ( pkt_cnt < 1 ) | | ( transfer_len < RXDESC_SIZE ) | | ( pkt_len < = 0 ) )
2013-05-08 21:45:39 +00:00
{
return _FAIL ;
}
# endif
do {
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_info_ ,
( " recvbuf2recvframe: rxdesc=offsset 0:0x%08x, 4:0x%08x, 8:0x%08x, C:0x%08x \n " ,
prxstat - > rxdw0 , prxstat - > rxdw1 , prxstat - > rxdw2 , prxstat - > rxdw4 ) ) ;
prxstat = ( struct recv_stat * ) pbuf ;
precvframe = rtw_alloc_recvframe ( pfree_recv_queue ) ;
2013-05-09 04:04:25 +00:00
if ( precvframe = = NULL )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_err_ , ( " recvbuf2recvframe: precvframe==NULL \n " ) ) ;
2013-05-09 16:23:32 +00:00
DBG_8192C ( " %s()-%d: rtw_alloc_recvframe() failed! RX Drop! \n " , __func__ , __LINE__ ) ;
2013-05-08 21:45:39 +00:00
goto _exit_recvbuf2recvframe ;
}
_rtw_init_listhead ( & precvframe - > u . hdr . list ) ;
precvframe - > u . hdr . precvbuf = NULL ; //can't access the precvbuf for new arch.
precvframe - > u . hdr . len = 0 ;
//rtl8192c_query_rx_desc_status(precvframe, prxstat);
update_recvframe_attrib_88e ( precvframe , prxstat ) ;
pattrib = & precvframe - > u . hdr . attrib ;
if ( ( pattrib - > crc_err ) | | ( pattrib - > icv_err ) )
{
2013-05-09 16:23:32 +00:00
DBG_8192C ( " %s: RX Warning! crc_err=%d icv_err=%d, skip! \n " , __func__ , pattrib - > crc_err , pattrib - > icv_err ) ;
2013-05-08 21:45:39 +00:00
rtw_free_recvframe ( precvframe , pfree_recv_queue ) ;
goto _exit_recvbuf2recvframe ;
}
2013-05-09 04:04:25 +00:00
if ( ( pattrib - > physt ) & & ( pattrib - > pkt_rpt_type = = NORMAL_RX ) )
2013-05-08 21:45:39 +00:00
{
pphy_status = ( struct phy_stat * ) ( pbuf + RXDESC_OFFSET ) ;
}
pkt_offset = RXDESC_SIZE + pattrib - > drvinfo_sz + pattrib - > shift_sz + pattrib - > pkt_len ;
2013-05-09 04:04:25 +00:00
if ( ( pattrib - > pkt_len < = 0 ) | | ( pkt_offset > transfer_len ) )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_info_ , ( " recvbuf2recvframe: pkt_len<=0 \n " ) ) ;
2013-05-09 16:23:32 +00:00
DBG_8192C ( " %s()-%d: RX Warning!,pkt_len<=0 or pkt_offset> transfoer_len \n " , __func__ , __LINE__ ) ;
2013-05-08 21:45:39 +00:00
rtw_free_recvframe ( precvframe , pfree_recv_queue ) ;
goto _exit_recvbuf2recvframe ;
}
// Modified by Albert 20101213
// For 8 bytes IP header alignment.
if ( pattrib - > qos ) // Qos data, wireless lan header length is 26
{
shift_sz = 6 ;
}
else
{
shift_sz = 0 ;
}
skb_len = pattrib - > pkt_len ;
// for first fragment packet, driver need allocate 1536+drvinfo_sz+RXDESC_SIZE to defrag packet.
// modify alloc_sz for recvive crc error packet by thomas 2011-06-02
2013-05-09 04:04:25 +00:00
if ( ( pattrib - > mfrag = = 1 ) & & ( pattrib - > frag_num = = 0 ) ) {
2013-05-08 21:45:39 +00:00
//alloc_sz = 1664; //1664 is 128 alignment.
2013-05-09 04:04:25 +00:00
if ( skb_len < = 1650 )
2013-05-08 21:45:39 +00:00
alloc_sz = 1664 ;
else
alloc_sz = skb_len + 14 ;
}
else {
alloc_sz = skb_len ;
// 6 is for IP header 8 bytes alignment in QoS packet case.
// 8 is for skb->data 4 bytes alignment.
alloc_sz + = 14 ;
}
# if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html
pkt_copy = dev_alloc_skb ( alloc_sz ) ;
# else
pkt_copy = netdev_alloc_skb ( padapter - > pnetdev , alloc_sz ) ;
# endif
2013-05-09 04:04:25 +00:00
if ( pkt_copy )
2013-05-08 21:45:39 +00:00
{
pkt_copy - > dev = padapter - > pnetdev ;
precvframe - > u . hdr . pkt = pkt_copy ;
precvframe - > u . hdr . rx_head = pkt_copy - > data ;
precvframe - > u . hdr . rx_end = pkt_copy - > data + alloc_sz ;
skb_reserve ( pkt_copy , 8 - ( ( SIZE_PTR ) ( pkt_copy - > data ) & 7 ) ) ; //force pkt_copy->data at 8-byte alignment address
skb_reserve ( pkt_copy , shift_sz ) ; //force ip_hdr at 8-byte alignment address according to shift_sz.
_rtw_memcpy ( pkt_copy - > data , ( pbuf + pattrib - > drvinfo_sz + RXDESC_SIZE ) , skb_len ) ;
precvframe - > u . hdr . rx_data = precvframe - > u . hdr . rx_tail = pkt_copy - > data ;
}
else
{
2013-05-09 04:04:25 +00:00
if ( ( pattrib - > mfrag = = 1 ) & & ( pattrib - > frag_num = = 0 ) )
2013-05-08 21:45:39 +00:00
{
2013-05-09 04:09:18 +00:00
DBG_8192C ( " recvbuf2recvframe: alloc_skb fail , drop frag frame \n " ) ;
2013-05-08 21:45:39 +00:00
rtw_free_recvframe ( precvframe , pfree_recv_queue ) ;
goto _exit_recvbuf2recvframe ;
}
precvframe - > u . hdr . pkt = skb_clone ( pskb , GFP_ATOMIC ) ;
2013-05-09 04:04:25 +00:00
if ( precvframe - > u . hdr . pkt )
2013-05-08 21:45:39 +00:00
{
precvframe - > u . hdr . rx_head = precvframe - > u . hdr . rx_data = precvframe - > u . hdr . rx_tail
= pbuf + pattrib - > drvinfo_sz + RXDESC_SIZE ;
precvframe - > u . hdr . rx_end = pbuf + pattrib - > drvinfo_sz + RXDESC_SIZE + alloc_sz ;
}
else
{
DBG_8192C ( " recvbuf2recvframe: skb_clone fail \n " ) ;
rtw_free_recvframe ( precvframe , pfree_recv_queue ) ;
goto _exit_recvbuf2recvframe ;
}
}
recvframe_put ( precvframe , skb_len ) ;
//recvframe_pull(precvframe, drvinfo_sz + RXDESC_SIZE);
# ifdef CONFIG_USB_RX_AGGREGATION
2013-05-09 04:04:25 +00:00
switch ( pHalData - > UsbRxAggMode )
2013-05-08 21:45:39 +00:00
{
case USB_RX_AGG_DMA :
case USB_RX_AGG_MIX :
pkt_offset = ( u16 ) _RND128 ( pkt_offset ) ;
break ;
case USB_RX_AGG_USB :
pkt_offset = ( u16 ) _RND4 ( pkt_offset ) ;
break ;
case USB_RX_AGG_DISABLE :
default :
break ;
}
# endif
2013-05-09 04:04:25 +00:00
if ( pattrib - > pkt_rpt_type = = NORMAL_RX ) //Normal rx packet
2013-05-08 21:45:39 +00:00
{
# ifdef CONFIG_CONCURRENT_MODE
2013-05-09 04:04:25 +00:00
if ( rtw_buddy_adapter_up ( padapter ) )
2013-05-08 21:45:39 +00:00
{
2013-05-09 04:04:25 +00:00
if ( pre_recv_entry ( precvframe , prxstat , pphy_status ) ! = _SUCCESS )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_err_ ,
( " recvbuf2recvframe: recv_entry(precvframe) != _SUCCESS \n " ) ) ;
}
}
else
# endif
{
if ( pattrib - > physt )
update_recvframe_phyinfo_88e ( precvframe , ( struct phy_stat * ) pphy_status ) ;
2013-05-09 04:04:25 +00:00
if ( rtw_recv_entry ( precvframe ) ! = _SUCCESS )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_rtl871x_recv_c_ , _drv_err_ ,
( " recvbuf2recvframe: rtw_recv_entry(precvframe) != _SUCCESS \n " ) ) ;
}
}
}
else { // pkt_rpt_type == TX_REPORT1-CCX, TX_REPORT2-TX RTP,HIS_REPORT-USB HISR RTP
//enqueue recvframe to txrtp queue
2013-05-09 04:04:25 +00:00
if ( pattrib - > pkt_rpt_type = = TX_REPORT1 ) {
2013-05-09 04:09:18 +00:00
//DBG_8192C("rx CCX\n");
2013-05-08 21:45:39 +00:00
//CCX-TXRPT ack for xmit mgmt frames.
handle_txrpt_ccx_88e ( padapter , precvframe - > u . hdr . rx_data ) ;
}
2013-05-09 04:04:25 +00:00
else if ( pattrib - > pkt_rpt_type = = TX_REPORT2 ) {
2013-05-09 04:09:18 +00:00
//DBG_8192C("rx TX RPT\n");
2013-05-08 21:45:39 +00:00
ODM_RA_TxRPT2Handle_8188E (
& pHalData - > odmpriv ,
precvframe - > u . hdr . rx_data ,
pattrib - > pkt_len ,
pattrib - > MacIDValidEntry [ 0 ] ,
pattrib - > MacIDValidEntry [ 1 ]
) ;
}
2013-05-09 04:04:25 +00:00
else if ( pattrib - > pkt_rpt_type = = HIS_REPORT )
2013-05-08 21:45:39 +00:00
{
2013-05-09 16:23:32 +00:00
//DBG_8192C("%s , rx USB HISR\n",__func__);
2013-05-08 21:45:39 +00:00
# ifdef CONFIG_SUPPORT_USB_INT
interrupt_handler_8188eu ( padapter , pattrib - > pkt_len , precvframe - > u . hdr . rx_data ) ;
# endif
}
rtw_free_recvframe ( precvframe , pfree_recv_queue ) ;
}
pkt_cnt - - ;
transfer_len - = pkt_offset ;
pbuf + = pkt_offset ;
precvframe = NULL ;
pkt_copy = NULL ;
2013-05-09 04:04:25 +00:00
if ( transfer_len > 0 & & pkt_cnt = = 0 )
2013-05-08 21:45:39 +00:00
pkt_cnt = ( le32_to_cpu ( prxstat - > rxdw2 ) > > 16 ) & 0xff ;
2013-05-09 04:04:25 +00:00
} while ( ( transfer_len > 0 ) & & ( pkt_cnt > 0 ) ) ;
2013-05-08 21:45:39 +00:00
_exit_recvbuf2recvframe :
return _SUCCESS ;
}
void rtl8188eu_recv_tasklet ( void * priv )
{
_pkt * pskb ;
_adapter * padapter = ( _adapter * ) priv ;
struct recv_priv * precvpriv = & padapter - > recvpriv ;
while ( NULL ! = ( pskb = skb_dequeue ( & precvpriv - > rx_skb_queue ) ) )
{
if ( ( padapter - > bDriverStopped = = _TRUE ) | | ( padapter - > bSurpriseRemoved = = _TRUE ) )
{
2013-05-09 04:09:18 +00:00
DBG_8192C ( " recv_tasklet => bDriverStopped or bSurpriseRemoved \n " ) ;
2013-05-08 21:45:39 +00:00
dev_kfree_skb_any ( pskb ) ;
break ;
}
recvbuf2recvframe ( padapter , pskb ) ;
# ifdef CONFIG_PREALLOC_RECV_SKB
skb_reset_tail_pointer ( pskb ) ;
pskb - > len = 0 ;
skb_queue_tail ( & precvpriv - > free_recv_skb_queue , pskb ) ;
# else
dev_kfree_skb_any ( pskb ) ;
# endif
}
}
static void usb_read_port_complete ( struct urb * purb , struct pt_regs * regs )
{
_irqL irqL ;
uint isevt , * pbuf ;
struct recv_buf * precvbuf = ( struct recv_buf * ) purb - > context ;
_adapter * padapter = ( _adapter * ) precvbuf - > adapter ;
struct recv_priv * precvpriv = & padapter - > recvpriv ;
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete!!! \n " ) ) ;
//_enter_critical(&precvpriv->lock, &irqL);
//precvbuf->irp_pending=_FALSE;
//precvpriv->rx_pending_cnt --;
//_exit_critical(&precvpriv->lock, &irqL);
precvpriv - > rx_pending_cnt - - ;
2013-05-09 04:04:25 +00:00
//if (precvpriv->rx_pending_cnt== 0)
2013-05-08 21:45:39 +00:00
//{
// RT_TRACE(_module_hci_ops_os_c_,_drv_err_,("usb_read_port_complete: rx_pending_cnt== 0, set allrxreturnevt!\n"));
// _rtw_up_sema(&precvpriv->allrxreturnevt);
//}
2013-05-09 04:04:25 +00:00
if ( padapter - > bSurpriseRemoved | | padapter - > bDriverStopped | | padapter - > bReadPortCancel )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete:bDriverStopped(%d) OR bSurpriseRemoved(%d) \n " , padapter - > bDriverStopped , padapter - > bSurpriseRemoved ) ) ;
# ifdef CONFIG_PREALLOC_RECV_SKB
precvbuf - > reuse = _TRUE ;
# else
2013-05-09 04:04:25 +00:00
if ( precvbuf - > pskb ) {
2013-05-08 21:45:39 +00:00
DBG_8192C ( " ==> free skb(%p) \n " , precvbuf - > pskb ) ;
dev_kfree_skb_any ( precvbuf - > pskb ) ;
}
# endif
DBG_8192C ( " %s() RX Warning! bDriverStopped(%d) OR bSurpriseRemoved(%d) bReadPortCancel(%d) \n " ,
2013-05-09 16:23:32 +00:00
__func__ , padapter - > bDriverStopped , padapter - > bSurpriseRemoved , padapter - > bReadPortCancel ) ;
2013-05-08 21:45:39 +00:00
goto exit ;
}
2013-05-09 04:04:25 +00:00
if ( purb - > status = = 0 ) //SUCCESS
2013-05-08 21:45:39 +00:00
{
if ( ( purb - > actual_length > MAX_RECVBUF_SZ ) | | ( purb - > actual_length < RXDESC_SIZE ) )
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete: (purb->actual_length > MAX_RECVBUF_SZ) || (purb->actual_length < RXDESC_SIZE) \n " ) ) ;
precvbuf - > reuse = _TRUE ;
rtw_read_port ( padapter , precvpriv - > ff_hwaddr , 0 , ( unsigned char * ) precvbuf ) ;
2013-05-09 16:23:32 +00:00
DBG_8192C ( " %s()-%d: RX Warning! \n " , __func__ , __LINE__ ) ;
2013-05-08 21:45:39 +00:00
}
else
{
rtw_reset_continual_urb_error ( adapter_to_dvobj ( padapter ) ) ;
precvbuf - > transfer_len = purb - > actual_length ;
skb_put ( precvbuf - > pskb , purb - > actual_length ) ;
skb_queue_tail ( & precvpriv - > rx_skb_queue , precvbuf - > pskb ) ;
if ( skb_queue_len ( & precvpriv - > rx_skb_queue ) < = 1 )
tasklet_schedule ( & precvpriv - > recv_tasklet ) ;
precvbuf - > pskb = NULL ;
precvbuf - > reuse = _FALSE ;
rtw_read_port ( padapter , precvpriv - > ff_hwaddr , 0 , ( unsigned char * ) precvbuf ) ;
}
}
else
{
2013-05-09 04:09:18 +00:00
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete : purb->status(%d) != 0 \n " , purb - > status ) ) ;
2013-05-08 21:45:39 +00:00
DBG_8192C ( " ###=> usb_read_port_complete => urb status(%d) \n " , purb - > status ) ;
2013-05-09 04:04:25 +00:00
if ( rtw_inc_and_chk_continual_urb_error ( adapter_to_dvobj ( padapter ) ) = = _TRUE ) {
2013-05-08 21:45:39 +00:00
padapter - > bSurpriseRemoved = _TRUE ;
}
2013-05-09 04:04:25 +00:00
switch ( purb - > status ) {
2013-05-08 21:45:39 +00:00
case - EINVAL :
case - EPIPE :
case - ENODEV :
case - ESHUTDOWN :
//padapter->bSurpriseRemoved=_TRUE;
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete:bSurpriseRemoved=TRUE \n " ) ) ;
case - ENOENT :
padapter - > bDriverStopped = _TRUE ;
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port_complete:bDriverStopped=TRUE \n " ) ) ;
break ;
case - EPROTO :
case - EOVERFLOW :
# ifdef DBG_CONFIG_ERROR_DETECT
{
HAL_DATA_TYPE * pHalData = GET_HAL_DATA ( padapter ) ;
pHalData - > srestpriv . Wifi_Error_Status = USB_READ_PORT_FAIL ;
}
# endif
precvbuf - > reuse = _TRUE ;
rtw_read_port ( padapter , precvpriv - > ff_hwaddr , 0 , ( unsigned char * ) precvbuf ) ;
break ;
case - EINPROGRESS :
DBG_8192C ( " ERROR: URB IS IN PROGRESS!/n " ) ;
break ;
default :
break ;
}
}
exit :
_func_exit_ ;
}
static u32 usb_read_port ( struct intf_hdl * pintfhdl , u32 addr , u32 cnt , u8 * rmem )
{
_irqL irqL ;
int err ;
unsigned int pipe ;
SIZE_PTR tmpaddr = 0 ;
SIZE_PTR alignment = 0 ;
u32 ret = _SUCCESS ;
PURB purb = NULL ;
struct recv_buf * precvbuf = ( struct recv_buf * ) rmem ;
_adapter * adapter = pintfhdl - > padapter ;
struct dvobj_priv * pdvobj = adapter_to_dvobj ( adapter ) ;
struct recv_priv * precvpriv = & adapter - > recvpriv ;
struct usb_device * pusbd = pdvobj - > pusbdev ;
_func_enter_ ;
2013-05-09 04:04:25 +00:00
if ( adapter - > bDriverStopped | | adapter - > bSurpriseRemoved | | adapter - > pwrctrlpriv . pnp_bstop_trx )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port:( padapter->bDriverStopped ||padapter->bSurpriseRemoved ||adapter->pwrctrlpriv.pnp_bstop_trx)!!! \n " ) ) ;
return _FAIL ;
}
# ifdef CONFIG_PREALLOC_RECV_SKB
2013-05-09 04:04:25 +00:00
if ( ( precvbuf - > reuse = = _FALSE ) | | ( precvbuf - > pskb = = NULL ) )
2013-05-08 21:45:39 +00:00
{
if ( NULL ! = ( precvbuf - > pskb = skb_dequeue ( & precvpriv - > free_recv_skb_queue ) ) )
{
precvbuf - > reuse = _TRUE ;
}
}
# endif
2013-05-09 04:04:25 +00:00
if ( precvbuf ! = NULL )
2013-05-08 21:45:39 +00:00
{
rtl8188eu_init_recvbuf ( adapter , precvbuf ) ;
//re-assign for linux based on skb
2013-05-09 04:04:25 +00:00
if ( ( precvbuf - > reuse = = _FALSE ) | | ( precvbuf - > pskb = = NULL ) )
2013-05-08 21:45:39 +00:00
{
//precvbuf->pskb = alloc_skb(MAX_RECVBUF_SZ, GFP_ATOMIC);//don't use this after v2.6.25
# if (LINUX_VERSION_CODE < KERNEL_VERSION(2,6,18)) // http://www.mail-archive.com/netdev@vger.kernel.org/msg17214.html
precvbuf - > pskb = dev_alloc_skb ( MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ ) ;
# else
precvbuf - > pskb = netdev_alloc_skb ( adapter - > pnetdev , MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ ) ;
# endif
2013-05-09 04:04:25 +00:00
if ( precvbuf - > pskb = = NULL )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " init_recvbuf(): alloc_skb fail! \n " ) ) ;
DBG_8192C ( " #### usb_read_port() alloc_skb fail!##### \n " ) ;
return _FAIL ;
}
tmpaddr = ( SIZE_PTR ) precvbuf - > pskb - > data ;
alignment = tmpaddr & ( RECVBUFF_ALIGN_SZ - 1 ) ;
skb_reserve ( precvbuf - > pskb , ( RECVBUFF_ALIGN_SZ - alignment ) ) ;
precvbuf - > phead = precvbuf - > pskb - > head ;
precvbuf - > pdata = precvbuf - > pskb - > data ;
precvbuf - > ptail = skb_tail_pointer ( precvbuf - > pskb ) ;
precvbuf - > pend = skb_end_pointer ( precvbuf - > pskb ) ;
precvbuf - > pbuf = precvbuf - > pskb - > data ;
}
else //reuse skb
{
precvbuf - > phead = precvbuf - > pskb - > head ;
precvbuf - > pdata = precvbuf - > pskb - > data ;
precvbuf - > ptail = skb_tail_pointer ( precvbuf - > pskb ) ;
precvbuf - > pend = skb_end_pointer ( precvbuf - > pskb ) ;
precvbuf - > pbuf = precvbuf - > pskb - > data ;
precvbuf - > reuse = _FALSE ;
}
//_enter_critical(&precvpriv->lock, &irqL);
//precvpriv->rx_pending_cnt++;
//precvbuf->irp_pending = _TRUE;
//_exit_critical(&precvpriv->lock, &irqL);
precvpriv - > rx_pending_cnt + + ;
purb = precvbuf - > purb ;
//translate DMA FIFO addr to pipehandle
pipe = ffaddr2pipehdl ( pdvobj , addr ) ;
usb_fill_bulk_urb ( purb , pusbd , pipe ,
precvbuf - > pbuf ,
MAX_RECVBUF_SZ ,
usb_read_port_complete ,
precvbuf ) ; //context is precvbuf
err = usb_submit_urb ( purb , GFP_ATOMIC ) ;
2013-05-09 04:04:25 +00:00
if ( ( err ) & & ( err ! = ( - EPERM ) ) )
2013-05-08 21:45:39 +00:00
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " cannot submit rx in-token(err=0x%.8x), URB_STATUS =0x%.8x " , err , purb - > status ) ) ;
DBG_8192C ( " cannot submit rx in-token(err = 0x%08x),urb_status = %d \n " , err , purb - > status ) ;
ret = _FAIL ;
}
}
else
{
RT_TRACE ( _module_hci_ops_os_c_ , _drv_err_ , ( " usb_read_port:precvbuf ==NULL \n " ) ) ;
ret = _FAIL ;
}
_func_exit_ ;
return ret ;
}
# endif // CONFIG_USE_USB_BUFFER_ALLOC_RX
void rtl8188eu_xmit_tasklet ( void * priv )
{
int ret = _FALSE ;
_adapter * padapter = ( _adapter * ) priv ;
struct xmit_priv * pxmitpriv = & padapter - > xmitpriv ;
2013-05-09 04:04:25 +00:00
if ( check_fwstate ( & padapter - > mlmepriv , _FW_UNDER_SURVEY ) = = _TRUE )
2013-05-08 21:45:39 +00:00
return ;
2013-05-09 04:04:25 +00:00
while ( 1 )
2013-05-08 21:45:39 +00:00
{
if ( ( padapter - > bDriverStopped = = _TRUE ) | | ( padapter - > bSurpriseRemoved = = _TRUE ) | | ( padapter - > bWritePortCancel = = _TRUE ) )
{
DBG_8192C ( " xmit_tasklet => bDriverStopped or bSurpriseRemoved or bWritePortCancel \n " ) ;
break ;
}
ret = rtl8188eu_xmitframe_complete ( padapter , pxmitpriv , NULL ) ;
2013-05-09 04:04:25 +00:00
if ( ret = = _FALSE )
2013-05-08 21:45:39 +00:00
break ;
}
}
void rtl8188eu_set_intf_ops ( struct _io_ops * pops )
{
_func_enter_ ;
_rtw_memset ( ( u8 * ) pops , 0 , sizeof ( struct _io_ops ) ) ;
pops - > _read8 = & usb_read8 ;
pops - > _read16 = & usb_read16 ;
pops - > _read32 = & usb_read32 ;
pops - > _read_mem = & usb_read_mem ;
pops - > _read_port = & usb_read_port ;
pops - > _write8 = & usb_write8 ;
pops - > _write16 = & usb_write16 ;
pops - > _write32 = & usb_write32 ;
pops - > _writeN = & usb_writeN ;
# ifdef CONFIG_USB_SUPPORT_ASYNC_VDN_REQ
pops - > _write8_async = & usb_async_write8 ;
pops - > _write16_async = & usb_async_write16 ;
pops - > _write32_async = & usb_async_write32 ;
# endif
pops - > _write_mem = & usb_write_mem ;
pops - > _write_port = & usb_write_port ;
pops - > _read_port_cancel = & usb_read_port_cancel ;
pops - > _write_port_cancel = & usb_write_port_cancel ;
# ifdef CONFIG_USB_INTERRUPT_IN_PIPE
pops - > _read_interrupt = & usb_read_interrupt ;
# endif
_func_exit_ ;
}
void rtl8188eu_set_hw_type ( _adapter * padapter )
{
padapter - > chip_type = RTL8188E ;
padapter - > HardwareType = HARDWARE_TYPE_RTL8188EU ;
DBG_871X ( " CHIP TYPE: RTL8188E \n " ) ;
}