drivers/staging/bcm/InterfaceTx.c

   1 #include "headers.h"
   2
   3 /*this is transmit call-back(BULK OUT)*/
   4 static void write_bulk_callback(struct urb *urb/*, struct pt_regs *regs*/)
   5 {
   6         PUSB_TCB pTcb= (PUSB_TCB)urb->context;
   7         PS_INTERFACE_ADAPTER psIntfAdapter = pTcb->psIntfAdapter;
   8         CONTROL_MESSAGE *pControlMsg = (CONTROL_MESSAGE *)urb->transfer_buffer;
   9         PMINI_ADAPTER psAdapter = psIntfAdapter->psAdapter ;
  10         BOOLEAN bpowerDownMsg = FALSE ;
  11     PMINI_ADAPTER Adapter = GET_BCM_ADAPTER(gblpnetdev);
  12
  13     if (unlikely(netif_msg_tx_done(Adapter)))
  14             pr_info(PFX "%s: transmit status %d\n", Adapter->dev->name, urb->status);
  15
  16         if(urb->status != STATUS_SUCCESS)
  17         {
  18                 if(urb->status == -EPIPE)
  19                 {
  20                         psIntfAdapter->psAdapter->bEndPointHalted = TRUE ;
  21                         wake_up(&psIntfAdapter->psAdapter->tx_packet_wait_queue);
  22                 }
  23                 else
  24                 {
  25                         BCM_DEBUG_PRINT(Adapter,DBG_TYPE_TX, NEXT_SEND, DBG_LVL_ALL,"Tx URB has got cancelled. status :%d", urb->status);
  26                 }
  27         }
  28
  29         pTcb->bUsed = FALSE;
  30         atomic_dec(&psIntfAdapter->uNumTcbUsed);
  31
  32
  33
  34         if(TRUE == psAdapter->bPreparingForLowPowerMode)
  35         {
  36
  37                 if(((pControlMsg->szData[0] == GO_TO_IDLE_MODE_PAYLOAD) &&
  38                         (pControlMsg->szData[1] == TARGET_CAN_GO_TO_IDLE_MODE)))
  39
  40                 {
  41                         bpowerDownMsg = TRUE ;
  42                         //This covers the bus err while Idle Request msg sent down.
  43                         if(urb->status != STATUS_SUCCESS)
  44                         {
  45                                 psAdapter->bPreparingForLowPowerMode = FALSE ;
  46                                 BCM_DEBUG_PRINT(Adapter,DBG_TYPE_TX, NEXT_SEND, DBG_LVL_ALL,"Idle Mode Request msg failed to reach to Modem");
  47                                 //Signalling the cntrl pkt path in Ioctl
  48                                 wake_up(&psAdapter->lowpower_mode_wait_queue);
  49                                 StartInterruptUrb(psIntfAdapter);
  50                                 goto err_exit;
  51                         }
  52
  53                         if(psAdapter->bDoSuspend == FALSE)
  54                         {
  55                                 psAdapter->IdleMode = TRUE;
  56                                 //since going in Idle mode completed hence making this var false;
  57                                 psAdapter->bPreparingForLowPowerMode = FALSE ;
  58
  59                                 BCM_DEBUG_PRINT(Adapter,DBG_TYPE_TX, NEXT_SEND, DBG_LVL_ALL, "Host Entered in Idle Mode State...");
  60                                 //Signalling the cntrl pkt path in Ioctl
  61                                 wake_up(&psAdapter->lowpower_mode_wait_queue);
  62                         }
  63
  64                 }
  65                 else if((pControlMsg->Leader.Status == LINK_UP_CONTROL_REQ) &&
  66                         (pControlMsg->szData[0] == LINK_UP_ACK) &&
  67                         (pControlMsg->szData[1] == LINK_SHUTDOWN_REQ_FROM_FIRMWARE)  &&
  68                         (pControlMsg->szData[2] == SHUTDOWN_ACK_FROM_DRIVER))
  69                 {
  70                         //This covers the bus err while shutdown Request msg sent down.
  71                         if(urb->status != STATUS_SUCCESS)
  72                         {
  73                                 psAdapter->bPreparingForLowPowerMode = FALSE ;
  74                                 BCM_DEBUG_PRINT(Adapter,DBG_TYPE_TX, NEXT_SEND, DBG_LVL_ALL,"Shutdown Request Msg failed to reach to Modem");
  75                                 //Signalling the cntrl pkt path in Ioctl
  76                                 wake_up(&psAdapter->lowpower_mode_wait_queue);
  77                                 StartInterruptUrb(psIntfAdapter);
  78                                 goto err_exit;
  79                         }
  80
  81                         bpowerDownMsg = TRUE ;
  82                         if(psAdapter->bDoSuspend == FALSE)
  83                         {
  84                                 psAdapter->bShutStatus = TRUE;
  85                                 //since going in shutdown mode completed hence making this var false;
  86                                 psAdapter->bPreparingForLowPowerMode = FALSE ;
  87                                 BCM_DEBUG_PRINT(Adapter,DBG_TYPE_TX, NEXT_SEND, DBG_LVL_ALL,"Host Entered in shutdown Mode State...");
  88                                 //Signalling the cntrl pkt path in Ioctl
  89                                 wake_up(&psAdapter->lowpower_mode_wait_queue);
  90                         }
  91                 }
  92
  93                 if(psAdapter->bDoSuspend && bpowerDownMsg)
  94                 {
  95                         //issuing bus suspend request
  96                         BCM_DEBUG_PRINT(Adapter,DBG_TYPE_TX, NEXT_SEND, DBG_LVL_ALL,"Issuing the Bus suspend request to USB stack");
  97                         psIntfAdapter->bPreparingForBusSuspend = TRUE;
  98                         schedule_work(&psIntfAdapter->usbSuspendWork);
  99
 100                 }
 101
 102         }
 103
 104 err_exit :
 105 #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 35)
 106         usb_buffer_free(urb->dev, urb->transfer_buffer_length,
 107                         urb->transfer_buffer, urb->transfer_dma);
 108 #else
 109         usb_free_coherent(urb->dev, urb->transfer_buffer_length,
 110                         urb->transfer_buffer, urb->transfer_dma);
 111 #endif
 112 }
 113
 114
 115 static PUSB_TCB GetBulkOutTcb(PS_INTERFACE_ADAPTER psIntfAdapter)
 116 {
 117         PUSB_TCB pTcb = NULL;
 118         UINT index = 0;
 119
 120         if((atomic_read(&psIntfAdapter->uNumTcbUsed) < MAXIMUM_USB_TCB) &&
 121                 (psIntfAdapter->psAdapter->StopAllXaction ==FALSE))
 122         {
 123                 index = atomic_read(&psIntfAdapter->uCurrTcb);
 124                 pTcb = &psIntfAdapter->asUsbTcb[index];
 125                 pTcb->bUsed = TRUE;
 126                 pTcb->psIntfAdapter= psIntfAdapter;
 127                 BCM_DEBUG_PRINT(psIntfAdapter->psAdapter,DBG_TYPE_TX, NEXT_SEND, DBG_LVL_ALL, "Got Tx desc %d used %d",
 128                         index, atomic_read(&psIntfAdapter->uNumTcbUsed));
 129                 index = (index + 1) % MAXIMUM_USB_TCB;
 130                 atomic_set(&psIntfAdapter->uCurrTcb, index);
 131                 atomic_inc(&psIntfAdapter->uNumTcbUsed);
 132         }
 133         return pTcb;
 134 }
 135
 136 static int TransmitTcb(PS_INTERFACE_ADAPTER psIntfAdapter, PUSB_TCB pTcb, PVOID data, int len)
 137 {
 138
 139         struct urb *urb = pTcb->urb;
 140         int retval = 0;
 141
 142 #if LINUX_VERSION_CODE < KERNEL_VERSION(2, 6, 35)
 143         urb->transfer_buffer = usb_buffer_alloc(psIntfAdapter->udev, len,
 144                                                 GFP_ATOMIC, &urb->transfer_dma);
 145 #else
 146         urb->transfer_buffer = usb_alloc_coherent(psIntfAdapter->udev, len,
 147                                                 GFP_ATOMIC, &urb->transfer_dma);
 148 #endif
 149
 150         if (!urb->transfer_buffer)
 151         {
 152                 BCM_DEBUG_PRINT(psIntfAdapter->psAdapter,DBG_TYPE_PRINTK, 0, 0, "Error allocating memory\n");
 153                 return  -ENOMEM;
 154         }
 155         memcpy(urb->transfer_buffer, data, len);
 156         urb->transfer_buffer_length = len;
 157
 158         BCM_DEBUG_PRINT(psIntfAdapter->psAdapter,DBG_TYPE_TX, NEXT_SEND, DBG_LVL_ALL, "Sending Bulk out packet\n");
 159         //For T3B,INT OUT end point will be used as bulk out end point
 160         if((psIntfAdapter->psAdapter->chip_id == T3B) && (psIntfAdapter->bHighSpeedDevice == TRUE))
 161         {
 162                 usb_fill_int_urb(urb, psIntfAdapter->udev,
 163                 psIntfAdapter->sBulkOut.bulk_out_pipe,
 164                         urb->transfer_buffer, len, write_bulk_callback, pTcb,
 165                         psIntfAdapter->sBulkOut.int_out_interval);
 166         }
 167         else
 168         {
 169         usb_fill_bulk_urb(urb, psIntfAdapter->udev,
 170                   psIntfAdapter->sBulkOut.bulk_out_pipe,
 171                   urb->transfer_buffer, len, write_bulk_callback, pTcb);
 172         }
 173         urb->transfer_flags |= URB_NO_TRANSFER_DMA_MAP; /* For DMA transfer */
 174
 175         if(FALSE == psIntfAdapter->psAdapter->device_removed &&
 176            FALSE == psIntfAdapter->psAdapter->bEndPointHalted &&
 177            FALSE == psIntfAdapter->bSuspended &&
 178            FALSE == psIntfAdapter->bPreparingForBusSuspend)
 179         {
 180                 retval = usb_submit_urb(urb, GFP_ATOMIC);
 181                 if (retval)
 182                 {
 183                         BCM_DEBUG_PRINT(psIntfAdapter->psAdapter,DBG_TYPE_TX, NEXT_SEND, DBG_LVL_ALL, "failed submitting write urb, error %d", retval);
 184                         if(retval == -EPIPE)
 185                         {
 186                                 psIntfAdapter->psAdapter->bEndPointHalted = TRUE ;
 187                                 wake_up(&psIntfAdapter->psAdapter->tx_packet_wait_queue);
 188                         }
 189                 }
 190         }
 191         return retval;
 192 }
 193
 194 int InterfaceTransmitPacket(PVOID arg, PVOID data, UINT len)
 195 {
 196         PUSB_TCB pTcb= NULL;
 197
 198         PS_INTERFACE_ADAPTER psIntfAdapter = (PS_INTERFACE_ADAPTER)arg;
 199         pTcb= GetBulkOutTcb(psIntfAdapter);
 200         if(pTcb == NULL)
 201         {
 202                 BCM_DEBUG_PRINT(psIntfAdapter->psAdapter,DBG_TYPE_PRINTK, 0, 0, "No URB to transmit packet, dropping packet");
 203                 return -EFAULT;
 204         }
 205         return TransmitTcb(psIntfAdapter, pTcb, data, len);
 206 }
 207
 208