Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / drivers / staging / rtl8188eu / hal / rtl8188eu_recv.c

diff --git a/kernel/drivers/staging/rtl8188eu/hal/rtl8188eu_recv.c b/kernel/drivers/staging/rtl8188eu/hal/rtl8188eu_recv.c
new file mode 100644 (file)
index 0000000..06d1e65
--- /dev/null
+++ b/kernel/drivers/staging/rtl8188eu/hal/rtl8188eu_recv.c
@@ -0,0 +1,120 @@
+/******************************************************************************
+ *
+ * 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 _RTL8188EU_RECV_C_
+#include <osdep_service.h>
+#include <drv_types.h>
+#include <recv_osdep.h>
+#include <mlme_osdep.h>
+
+#include <usb_ops_linux.h>
+#include <wifi.h>
+
+#include <rtl8188e_hal.h>
+
+int    rtl8188eu_init_recv_priv(struct adapter *padapter)
+{
+       struct recv_priv        *precvpriv = &padapter->recvpriv;
+       int     i, res = _SUCCESS;
+       struct recv_buf *precvbuf;
+
+       tasklet_init(&precvpriv->recv_tasklet,
+                    (void(*)(unsigned long))rtl8188eu_recv_tasklet,
+                    (unsigned long)padapter);
+
+       /* init recv_buf */
+       _rtw_init_queue(&precvpriv->free_recv_buf_queue);
+
+       precvpriv->pallocated_recv_buf =
+               kcalloc(NR_RECVBUFF, sizeof(struct recv_buf), GFP_KERNEL);
+       if (precvpriv->pallocated_recv_buf == NULL) {
+               res = _FAIL;
+               RT_TRACE(_module_rtl871x_recv_c_, _drv_err_,
+                               ("alloc recv_buf fail!\n"));
+               goto exit;
+       }
+
+       precvpriv->precv_buf = precvpriv->pallocated_recv_buf;
+
+
+       precvbuf = (struct recv_buf *)precvpriv->precv_buf;
+
+       for (i = 0; i < NR_RECVBUFF; i++) {
+               res = rtw_os_recvbuf_resource_alloc(padapter, precvbuf);
+               if (res == _FAIL)
+                       break;
+               precvbuf->adapter = padapter;
+               precvbuf++;
+       }
+       precvpriv->free_recv_buf_queue_cnt = NR_RECVBUFF;
+       skb_queue_head_init(&precvpriv->rx_skb_queue);
+       {
+               int i;
+               size_t tmpaddr = 0;
+               size_t alignm = 0;
+               struct sk_buff *pskb = NULL;
+
+               skb_queue_head_init(&precvpriv->free_recv_skb_queue);
+
+               for (i = 0; i < NR_PREALLOC_RECV_SKB; i++) {
+                       pskb = __netdev_alloc_skb(padapter->pnetdev,
+                                       MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ,
+                                       GFP_KERNEL);
+                       if (pskb) {
+                               pskb->dev = padapter->pnetdev;
+                               tmpaddr = (size_t)pskb->data;
+                               alignm = tmpaddr & (RECVBUFF_ALIGN_SZ-1);
+                               skb_reserve(pskb, (RECVBUFF_ALIGN_SZ - alignm));
+
+                               skb_queue_tail(&precvpriv->free_recv_skb_queue,
+                                               pskb);
+                       }
+                       pskb = NULL;
+               }
+       }
+exit:
+       return res;
+}
+
+void rtl8188eu_free_recv_priv(struct adapter *padapter)
+{
+       int     i;
+       struct recv_buf *precvbuf;
+       struct recv_priv        *precvpriv = &padapter->recvpriv;
+
+       precvbuf = (struct recv_buf *)precvpriv->precv_buf;
+
+       for (i = 0; i < NR_RECVBUFF; i++) {
+               usb_free_urb(precvbuf->purb);
+               precvbuf++;
+       }
+
+       kfree(precvpriv->pallocated_recv_buf);
+
+       if (skb_queue_len(&precvpriv->rx_skb_queue))
+               DBG_88E(KERN_WARNING "rx_skb_queue not empty\n");
+       skb_queue_purge(&precvpriv->rx_skb_queue);
+
+
+       if (skb_queue_len(&precvpriv->free_recv_skb_queue))
+               DBG_88E(KERN_WARNING "free_recv_skb_queue not empty, %d\n",
+                               skb_queue_len(&precvpriv->free_recv_skb_queue));
+
+       skb_queue_purge(&precvpriv->free_recv_skb_queue);
+}