net: wireless: rockchip: add rtl8822be pcie wifi driver

[firefly-linux-kernel-4.4.55.git] / drivers / net / wireless / rockchip_wlan / rtl8822be / hal / rtl8822b / pci / rtl8822be_halmac.c

diff --git a/drivers/net/wireless/rockchip_wlan/rtl8822be/hal/rtl8822b/pci/rtl8822be_halmac.c b/drivers/net/wireless/rockchip_wlan/rtl8822be/hal/rtl8822b/pci/rtl8822be_halmac.c
new file mode 100644 (file)
index 0000000..d9a8270
--- /dev/null
+++ b/drivers/net/wireless/rockchip_wlan/rtl8822be/hal/rtl8822b/pci/rtl8822be_halmac.c
@@ -0,0 +1,132 @@
+/******************************************************************************
+ *
+ * Copyright(c) 2015 - 2016 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 _RTL8822BE_HALMAC_C_
+#include <drv_types.h>         /* struct dvobj_priv and etc. */
+#include "../../hal_halmac.h"
+
+static u8 pci_write_data_rsvd_page(void *d, u8 *pBuf, u32 size)
+{
+       struct dvobj_priv *pobj = (struct dvobj_priv *)d;
+       PADAPTER padapter = pobj->padapters[IFACE_ID0];
+       PHALMAC_ADAPTER halmac = dvobj_to_halmac((struct dvobj_priv *)d);
+       struct xmit_priv        *pxmitpriv = &padapter->xmitpriv;
+       struct xmit_frame       *pcmdframe = NULL;
+       struct pkt_attrib       *pattrib = NULL;
+       PHALMAC_API api = HALMAC_GET_API(halmac);
+       u8 desclen = 0;
+       u8 *txdesc = NULL;
+
+                                                                                
+        if (size + TXDESC_OFFSET > MAX_CMDBUF_SZ) {                             
+                RTW_INFO("%s: total buffer size(%d) > MAX_CMDBUF_SZ(%d)\n"         
+                         , __func__, size + TXDESC_OFFSET, MAX_CMDBUF_SZ);         
+                return _FALSE;                                                  
+        }                                                                       
+
+        pcmdframe = rtw_alloc_cmdxmitframe(pxmitpriv);                          
+
+       if (pcmdframe == NULL) {
+               RTW_INFO("%s: alloc ReservedPagePacket fail!\n", __func__);
+               return _FALSE;
+       }
+
+       desclen = HALMAC_TX_DESC_SIZE_8822B;
+       txdesc = pcmdframe->buf_addr;
+
+       _rtw_memcpy((txdesc + desclen), pBuf, size); /* shift desclen */
+
+       /* update attribute */
+       pattrib = &pcmdframe->attrib;
+       update_mgntframe_attrib(padapter, pattrib);
+       pattrib->qsel = QSLT_BEACON;
+       pattrib->pktlen = size;
+       pattrib->last_txcmdsz = size;
+
+       dump_mgntframe(padapter, pcmdframe);
+
+       return _TRUE;
+}
+
+static u8 pci_write_data_h2c(void *d, u8 *pBuf, u32 size)
+{
+       struct dvobj_priv *pobj = (struct dvobj_priv *)d;
+       PADAPTER padapter = pobj->padapters[IFACE_ID0];
+       PHALMAC_ADAPTER halmac = dvobj_to_halmac((struct dvobj_priv *)d);
+       struct xmit_priv        *pxmitpriv = &padapter->xmitpriv;
+       struct xmit_frame       *pcmdframe = NULL;
+       struct pkt_attrib       *pattrib = NULL;
+       PHALMAC_API api;
+       u32 desclen;
+       u8 *buf;
+
+        if (size + TXDESC_OFFSET > MAX_XMIT_EXTBUF_SZ) {
+                RTW_INFO("%s: total buffer size(%d) > MAX_XMIT_EXTBUF_SZ(%d)\n"
+                         , __func__, size + TXDESC_OFFSET, MAX_XMIT_EXTBUF_SZ);
+                return _FALSE;
+        }
+
+       pcmdframe = alloc_mgtxmitframe(pxmitpriv);
+
+       if (pcmdframe == NULL) {
+               RTW_INFO("%s: alloc ReservedPagePacket fail!\n", __func__);
+               return _FALSE;
+       }
+
+       api = HALMAC_GET_API(halmac);
+
+       desclen = HALMAC_TX_DESC_SIZE_8822B;
+       buf = pcmdframe->buf_addr;
+       _rtw_memset(buf, 0, TXDESC_SIZE);
+       _rtw_memcpy(buf + desclen, pBuf, size); /* shift desclen */
+
+       SET_TX_DESC_TXPKTSIZE_8822B(buf, size);
+       SET_TX_DESC_OFFSET_8822B(buf, 0);
+       SET_TX_DESC_QSEL_8822B(buf, HALMAC_QUEUE_SELECT_CMD);
+       SET_TX_DESC_TXDESC_CHECKSUM_8822B(buf, 0);
+       api->halmac_fill_txdesc_checksum(halmac, buf);
+
+       /* update attribute */
+       pattrib = &pcmdframe->attrib;
+       update_mgntframe_attrib(padapter, pattrib);
+       pattrib->qsel = QSLT_CMD;
+       pattrib->pktlen = size;
+       pattrib->last_txcmdsz = size;
+
+       /* fill tx desc in dump_mgntframe */
+       dump_mgntframe(padapter, pcmdframe);
+
+       return _TRUE;
+}
+
+int rtl8822be_halmac_init_adapter(PADAPTER padapter)
+{
+       struct dvobj_priv *d;
+       PHALMAC_PLATFORM_API api;
+       int err;
+
+       d = adapter_to_dvobj(padapter);
+       api = &rtw_halmac_platform_api;
+       api->SEND_RSVD_PAGE = pci_write_data_rsvd_page;
+       api->SEND_H2C_PKT = pci_write_data_h2c;
+
+       err = rtw_halmac_init_adapter(d, api);
+
+       return err;
+}