2010-09-08 15:46:36 -06:00
# include "headers.h"
2010-11-01 11:34:35 -06:00
static int SearchVcid ( PMINI_ADAPTER Adapter , unsigned short usVcid )
{
int iIndex = 0 ;
for ( iIndex = ( NO_OF_QUEUES - 1 ) ; iIndex > = 0 ; iIndex - - )
if ( Adapter - > PackInfo [ iIndex ] . usVCID_Value = = usVcid )
return iIndex ;
return NO_OF_QUEUES + 1 ;
}
2010-09-08 15:46:36 -06:00
static PUSB_RCB
GetBulkInRcb ( PS_INTERFACE_ADAPTER psIntfAdapter )
{
PUSB_RCB pRcb = NULL ;
UINT index = 0 ;
if ( ( atomic_read ( & psIntfAdapter - > uNumRcbUsed ) < MAXIMUM_USB_RCB ) & &
( psIntfAdapter - > psAdapter - > StopAllXaction = = FALSE ) )
{
index = atomic_read ( & psIntfAdapter - > uCurrRcb ) ;
pRcb = & psIntfAdapter - > asUsbRcb [ index ] ;
pRcb - > bUsed = TRUE ;
pRcb - > psIntfAdapter = psIntfAdapter ;
BCM_DEBUG_PRINT ( psIntfAdapter - > psAdapter , DBG_TYPE_RX , RX_DPC , DBG_LVL_ALL , " Got Rx desc %d used %d " ,
index , atomic_read ( & psIntfAdapter - > uNumRcbUsed ) ) ;
index = ( index + 1 ) % MAXIMUM_USB_RCB ;
atomic_set ( & psIntfAdapter - > uCurrRcb , index ) ;
atomic_inc ( & psIntfAdapter - > uNumRcbUsed ) ;
}
return pRcb ;
}
2011-03-30 19:57:33 -06:00
/*this is receive call back - when pkt available for receive (BULK IN- end point)*/
2010-09-08 15:46:36 -06:00
static void read_bulk_callback ( struct urb * urb )
{
struct sk_buff * skb = NULL ;
BOOLEAN bHeaderSupressionEnabled = FALSE ;
int QueueIndex = NO_OF_QUEUES + 1 ;
UINT uiIndex = 0 ;
int process_done = 1 ;
//int idleflag = 0 ;
PUSB_RCB pRcb = ( PUSB_RCB ) urb - > context ;
PS_INTERFACE_ADAPTER psIntfAdapter = pRcb - > psIntfAdapter ;
PMINI_ADAPTER Adapter = psIntfAdapter - > psAdapter ;
PLEADER pLeader = urb - > transfer_buffer ;
2010-11-01 10:18:36 -06:00
if ( unlikely ( netif_msg_rx_status ( Adapter ) ) )
pr_info ( PFX " %s: rx urb status %d length %d \n " ,
Adapter - > dev - > name , urb - > status , urb - > actual_length ) ;
2010-09-08 15:46:36 -06:00
if ( ( Adapter - > device_removed = = TRUE ) | |
( TRUE = = Adapter - > bEndPointHalted ) | |
( 0 = = urb - > actual_length )
)
{
pRcb - > bUsed = FALSE ;
atomic_dec ( & psIntfAdapter - > uNumRcbUsed ) ;
return ;
}
if ( urb - > status ! = STATUS_SUCCESS )
{
if ( urb - > status = = - EPIPE )
{
Adapter - > bEndPointHalted = TRUE ;
wake_up ( & Adapter - > tx_packet_wait_queue ) ;
}
else
{
BCM_DEBUG_PRINT ( Adapter , DBG_TYPE_RX , RX_DPC , DBG_LVL_ALL , " Rx URB has got cancelled. status :%d " , urb - > status ) ;
}
pRcb - > bUsed = FALSE ;
atomic_dec ( & psIntfAdapter - > uNumRcbUsed ) ;
urb - > status = STATUS_SUCCESS ;
return ;
}
if ( Adapter - > bDoSuspend & & ( Adapter - > bPreparingForLowPowerMode ) )
{
BCM_DEBUG_PRINT ( Adapter , DBG_TYPE_RX , RX_DPC , DBG_LVL_ALL , " device is going in low power mode while PMU option selected..hence rx packet should not be process " ) ;
return ;
}
BCM_DEBUG_PRINT ( Adapter , DBG_TYPE_RX , RX_DPC , DBG_LVL_ALL , " Read back done len %d \n " , pLeader - > PLength ) ;
if ( ! pLeader - > PLength )
{
BCM_DEBUG_PRINT ( Adapter , DBG_TYPE_RX , RX_DPC , DBG_LVL_ALL , " Leader Length 0 " ) ;
atomic_dec ( & psIntfAdapter - > uNumRcbUsed ) ;
return ;
}
BCM_DEBUG_PRINT ( Adapter , DBG_TYPE_RX , RX_DPC , DBG_LVL_ALL , " Leader Status:0x%hX, Length:0x%hX, VCID:0x%hX " , pLeader - > Status , pLeader - > PLength , pLeader - > Vcid ) ;
if ( MAX_CNTL_PKT_SIZE < pLeader - > PLength )
{
2010-11-01 10:18:36 -06:00
if ( netif_msg_rx_err ( Adapter ) )
pr_info ( PFX " %s: corrupted leader length...%d \n " ,
Adapter - > dev - > name , pLeader - > PLength ) ;
2010-11-01 11:34:35 -06:00
+ + Adapter - > dev - > stats . rx_dropped ;
2010-09-08 15:46:36 -06:00
atomic_dec ( & psIntfAdapter - > uNumRcbUsed ) ;
return ;
}
QueueIndex = SearchVcid ( Adapter , pLeader - > Vcid ) ;
if ( QueueIndex < NO_OF_QUEUES )
{
bHeaderSupressionEnabled =
Adapter - > PackInfo [ QueueIndex ] . bHeaderSuppressionEnabled ;
bHeaderSupressionEnabled =
bHeaderSupressionEnabled & Adapter - > bPHSEnabled ;
}
skb = dev_alloc_skb ( pLeader - > PLength + SKB_RESERVE_PHS_BYTES + SKB_RESERVE_ETHERNET_HEADER ) ; //2 //2 for allignment
if ( ! skb )
{
BCM_DEBUG_PRINT ( Adapter , DBG_TYPE_PRINTK , 0 , 0 , " NO SKBUFF!!! Dropping the Packet " ) ;
atomic_dec ( & psIntfAdapter - > uNumRcbUsed ) ;
return ;
}
/* If it is a control Packet, then call handle_bcm_packet ()*/
if ( ( ntohs ( pLeader - > Vcid ) = = VCID_CONTROL_PACKET ) | |
( ! ( pLeader - > Status > = 0x20 & & pLeader - > Status < = 0x3F ) ) )
{
2011-03-30 19:57:33 -06:00
BCM_DEBUG_PRINT ( psIntfAdapter - > psAdapter , DBG_TYPE_RX , RX_CTRL , DBG_LVL_ALL , " Received control pkt... " ) ;
2010-09-08 15:46:36 -06:00
* ( PUSHORT ) skb - > data = pLeader - > Status ;
memcpy ( skb - > data + sizeof ( USHORT ) , urb - > transfer_buffer +
( sizeof ( LEADER ) ) , pLeader - > PLength ) ;
skb - > len = pLeader - > PLength + sizeof ( USHORT ) ;
spin_lock ( & Adapter - > control_queue_lock ) ;
ENQUEUEPACKET ( Adapter - > RxControlHead , Adapter - > RxControlTail , skb ) ;
spin_unlock ( & Adapter - > control_queue_lock ) ;
atomic_inc ( & Adapter - > cntrlpktCnt ) ;
wake_up ( & Adapter - > process_rx_cntrlpkt ) ;
}
else
{
/*
* Data Packet , Format a proper Ethernet Header
* and give it to the stack
*/
2011-03-30 19:57:33 -06:00
BCM_DEBUG_PRINT ( psIntfAdapter - > psAdapter , DBG_TYPE_RX , RX_DATA , DBG_LVL_ALL , " Received Data pkt... " ) ;
2010-09-08 15:46:36 -06:00
skb_reserve ( skb , 2 + SKB_RESERVE_PHS_BYTES ) ;
memcpy ( skb - > data + ETH_HLEN , ( PUCHAR ) urb - > transfer_buffer + sizeof ( LEADER ) , pLeader - > PLength ) ;
skb - > dev = Adapter - > dev ;
/* currently skb->len has extra ETH_HLEN bytes in the beginning */
skb_put ( skb , pLeader - > PLength + ETH_HLEN ) ;
Adapter - > PackInfo [ QueueIndex ] . uiTotalRxBytes + = pLeader - > PLength ;
Adapter - > PackInfo [ QueueIndex ] . uiThisPeriodRxBytes + = pLeader - > PLength ;
2011-03-30 19:57:33 -06:00
BCM_DEBUG_PRINT ( psIntfAdapter - > psAdapter , DBG_TYPE_RX , RX_DATA , DBG_LVL_ALL , " Received Data pkt of len :0x%X " , pLeader - > PLength ) ;
2010-09-08 15:46:36 -06:00
2010-10-29 22:39:54 -06:00
if ( netif_running ( Adapter - > dev ) )
2010-09-08 15:46:36 -06:00
{
/* Moving ahead by ETH_HLEN to the data ptr as received from FW */
skb_pull ( skb , ETH_HLEN ) ;
2011-06-23 12:40:18 -06:00
PHSReceive ( Adapter , pLeader - > Vcid , skb , & skb - > len ,
2010-09-08 15:46:36 -06:00
NULL , bHeaderSupressionEnabled ) ;
if ( ! Adapter - > PackInfo [ QueueIndex ] . bEthCSSupport )
{
skb_push ( skb , ETH_HLEN ) ;
memcpy ( skb - > data , skb - > dev - > dev_addr , 6 ) ;
memcpy ( skb - > data + 6 , skb - > dev - > dev_addr , 6 ) ;
( * ( skb - > data + 11 ) ) + + ;
* ( skb - > data + 12 ) = 0x08 ;
* ( skb - > data + 13 ) = 0x00 ;
pLeader - > PLength + = ETH_HLEN ;
}
skb - > protocol = eth_type_trans ( skb , Adapter - > dev ) ;
process_done = netif_rx ( skb ) ;
}
else
{
BCM_DEBUG_PRINT ( psIntfAdapter - > psAdapter , DBG_TYPE_RX , RX_DATA , DBG_LVL_ALL , " i/f not up hance freeing SKB... " ) ;
2010-11-01 07:35:21 -06:00
dev_kfree_skb ( skb ) ;
2010-09-08 15:46:36 -06:00
}
2010-11-01 11:34:35 -06:00
+ + Adapter - > dev - > stats . rx_packets ;
Adapter - > dev - > stats . rx_bytes + = pLeader - > PLength ;
2010-09-08 15:46:36 -06:00
for ( uiIndex = 0 ; uiIndex < MIBS_MAX_HIST_ENTRIES ; uiIndex + + )
{
if ( ( pLeader - > PLength < = MIBS_PKTSIZEHIST_RANGE * ( uiIndex + 1 ) )
& & ( pLeader - > PLength > MIBS_PKTSIZEHIST_RANGE * ( uiIndex ) ) )
Adapter - > aRxPktSizeHist [ uiIndex ] + + ;
}
}
Adapter - > PrevNumRecvDescs + + ;
pRcb - > bUsed = FALSE ;
atomic_dec ( & psIntfAdapter - > uNumRcbUsed ) ;
}
static int ReceiveRcb ( PS_INTERFACE_ADAPTER psIntfAdapter , PUSB_RCB pRcb )
{
struct urb * urb = pRcb - > urb ;
int retval = 0 ;
usb_fill_bulk_urb ( urb , psIntfAdapter - > udev , usb_rcvbulkpipe (
psIntfAdapter - > udev , psIntfAdapter - > sBulkIn . bulk_in_endpointAddr ) ,
urb - > transfer_buffer , BCM_USB_MAX_READ_LENGTH , read_bulk_callback ,
pRcb ) ;
if ( FALSE = = psIntfAdapter - > psAdapter - > device_removed & &
FALSE = = psIntfAdapter - > psAdapter - > bEndPointHalted & &
FALSE = = psIntfAdapter - > bSuspended & &
FALSE = = psIntfAdapter - > bPreparingForBusSuspend )
{
retval = usb_submit_urb ( urb , GFP_ATOMIC ) ;
if ( retval )
{
BCM_DEBUG_PRINT ( psIntfAdapter - > psAdapter , DBG_TYPE_RX , RX_DPC , DBG_LVL_ALL , " failed submitting read urb, error %d " , retval ) ;
//if this return value is because of pipe halt. need to clear this.
if ( retval = = - EPIPE )
{
psIntfAdapter - > psAdapter - > bEndPointHalted = TRUE ;
wake_up ( & psIntfAdapter - > psAdapter - > tx_packet_wait_queue ) ;
}
}
}
return retval ;
}
/*
Function : InterfaceRx
2011-06-23 12:40:18 -06:00
Description : This is the hardware specific Function for Receiving
2010-09-08 15:46:36 -06:00
data packet / control packets from the device .
Input parameters : IN PMINI_ADAPTER Adapter - Miniport Adapter Context
Return : TRUE - If Rx was successful .
2011-03-30 19:57:33 -06:00
Other - If an error occurred .
2010-09-08 15:46:36 -06:00
*/
BOOLEAN InterfaceRx ( PS_INTERFACE_ADAPTER psIntfAdapter )
{
USHORT RxDescCount = NUM_RX_DESC - atomic_read ( & psIntfAdapter - > uNumRcbUsed ) ;
PUSB_RCB pRcb = NULL ;
// RxDescCount = psIntfAdapter->psAdapter->CurrNumRecvDescs -
// psIntfAdapter->psAdapter->PrevNumRecvDescs;
while ( RxDescCount )
{
pRcb = GetBulkInRcb ( psIntfAdapter ) ;
if ( pRcb = = NULL )
{
BCM_DEBUG_PRINT ( psIntfAdapter - > psAdapter , DBG_TYPE_PRINTK , 0 , 0 , " Unable to get Rcb pointer " ) ;
return FALSE ;
}
//atomic_inc(&psIntfAdapter->uNumRcbUsed);
ReceiveRcb ( psIntfAdapter , pRcb ) ;
RxDescCount - - ;
}
return TRUE ;
}