drivers/staging/rtl8188eu/hal/rtl8188eu_recv.c

   1 /******************************************************************************
   2  *
   3  * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved.
   4  *
   5  * This program is free software; you can redistribute it and/or modify it
   6  * under the terms of version 2 of the GNU General Public License as
   7  * published by the Free Software Foundation.
   8  *
   9  * This program is distributed in the hope that it will be useful, but WITHOUT
  10  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  11  * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for
  12  * more details.
  13  *
  14  * You should have received a copy of the GNU General Public License along with
  15  * this program; if not, write to the Free Software Foundation, Inc.,
  16  * 51 Franklin Street, Fifth Floor, Boston, MA 02110, USA
  17  *
  18  *
  19  ******************************************************************************/
  20 #define _RTL8188EU_RECV_C_
  21 #include <osdep_service.h>
  22 #include <drv_types.h>
  23 #include <recv_osdep.h>
  24 #include <mlme_osdep.h>
  25 #include <ip.h>
  26 #include <if_ether.h>
  27 #include <ethernet.h>
  28
  29 #include <usb_ops.h>
  30 #include <wifi.h>
  31
  32 #include <rtl8188e_hal.h>
  33
  34 void rtl8188eu_init_recvbuf(struct adapter *padapter, struct recv_buf *precvbuf)
  35 {
  36         precvbuf->transfer_len = 0;
  37
  38         precvbuf->len = 0;
  39
  40         precvbuf->ref_cnt = 0;
  41
  42         if (precvbuf->pbuf) {
  43                 precvbuf->pdata = precvbuf->pbuf;
  44                 precvbuf->phead = precvbuf->pbuf;
  45                 precvbuf->ptail = precvbuf->pbuf;
  46                 precvbuf->pend = precvbuf->pdata + MAX_RECVBUF_SZ;
  47         }
  48 }
  49
  50 int     rtl8188eu_init_recv_priv(struct adapter *padapter)
  51 {
  52         struct recv_priv        *precvpriv = &padapter->recvpriv;
  53         int     i, res = _SUCCESS;
  54         struct recv_buf *precvbuf;
  55
  56         tasklet_init(&precvpriv->recv_tasklet,
  57                      (void(*)(unsigned long))rtl8188eu_recv_tasklet,
  58                      (unsigned long)padapter);
  59
  60         /* init recv_buf */
  61         _rtw_init_queue(&precvpriv->free_recv_buf_queue);
  62
  63         precvpriv->pallocated_recv_buf = rtw_zmalloc(NR_RECVBUFF * sizeof(struct recv_buf) + 4);
  64         if (precvpriv->pallocated_recv_buf == NULL) {
  65                 res = _FAIL;
  66                 RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, ("alloc recv_buf fail!\n"));
  67                 goto exit;
  68         }
  69         _rtw_memset(precvpriv->pallocated_recv_buf, 0, NR_RECVBUFF * sizeof(struct recv_buf) + 4);
  70
  71         precvpriv->precv_buf = (u8 *)N_BYTE_ALIGMENT((size_t)(precvpriv->pallocated_recv_buf), 4);
  72
  73
  74         precvbuf = (struct recv_buf *)precvpriv->precv_buf;
  75
  76         for (i = 0; i < NR_RECVBUFF; i++) {
  77                 _rtw_init_listhead(&precvbuf->list);
  78                 spin_lock_init(&precvbuf->recvbuf_lock);
  79                 precvbuf->alloc_sz = MAX_RECVBUF_SZ;
  80                 res = rtw_os_recvbuf_resource_alloc(padapter, precvbuf);
  81                 if (res == _FAIL)
  82                         break;
  83                 precvbuf->ref_cnt = 0;
  84                 precvbuf->adapter = padapter;
  85                 precvbuf++;
  86         }
  87         precvpriv->free_recv_buf_queue_cnt = NR_RECVBUFF;
  88         skb_queue_head_init(&precvpriv->rx_skb_queue);
  89         {
  90                 int i;
  91                 size_t tmpaddr = 0;
  92                 size_t alignment = 0;
  93                 struct sk_buff *pskb = NULL;
  94
  95                 skb_queue_head_init(&precvpriv->free_recv_skb_queue);
  96
  97                 for (i = 0; i < NR_PREALLOC_RECV_SKB; i++) {
  98                         pskb = __netdev_alloc_skb(padapter->pnetdev, MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ, GFP_KERNEL);
  99                         if (pskb) {
 100                                 pskb->dev = padapter->pnetdev;
 101                                 tmpaddr = (size_t)pskb->data;
 102                                 alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1);
 103                                 skb_reserve(pskb, (RECVBUFF_ALIGN_SZ - alignment));
 104
 105                                 skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb);
 106                         }
 107                         pskb = NULL;
 108                 }
 109         }
 110 exit:
 111         return res;
 112 }
 113
 114 void rtl8188eu_free_recv_priv(struct adapter *padapter)
 115 {
 116         int     i;
 117         struct recv_buf *precvbuf;
 118         struct recv_priv        *precvpriv = &padapter->recvpriv;
 119
 120         precvbuf = (struct recv_buf *)precvpriv->precv_buf;
 121
 122         for (i = 0; i < NR_RECVBUFF; i++) {
 123                 rtw_os_recvbuf_resource_free(padapter, precvbuf);
 124                 precvbuf++;
 125         }
 126
 127         kfree(precvpriv->pallocated_recv_buf);
 128
 129         if (skb_queue_len(&precvpriv->rx_skb_queue))
 130                 DBG_88E(KERN_WARNING "rx_skb_queue not empty\n");
 131         skb_queue_purge(&precvpriv->rx_skb_queue);
 132
 133
 134         if (skb_queue_len(&precvpriv->free_recv_skb_queue))
 135                 DBG_88E(KERN_WARNING "free_recv_skb_queue not empty, %d\n", skb_queue_len(&precvpriv->free_recv_skb_queue));
 136
 137         skb_queue_purge(&precvpriv->free_recv_skb_queue);
 138 }