1f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger/****************************************************************************** 2f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * 3f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Copyright(c) 2007 - 2011 Realtek Corporation. All rights reserved. 4f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * 5f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * This program is free software; you can redistribute it and/or modify it 6f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * under the terms of version 2 of the GNU General Public License as 7f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * published by the Free Software Foundation. 8f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * 9f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * This program is distributed in the hope that it will be useful, but WITHOUT 10f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 11f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 12f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * more details. 13f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * 14f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ******************************************************************************/ 15f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#define _HCI_OPS_OS_C_ 16f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 17f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <osdep_service.h> 18f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <drv_types.h> 19f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <osdep_intf.h> 20f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <usb_ops.h> 21f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <recv_osdep.h> 22f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <rtl8723a_hal.h> 23f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger#include <rtl8723a_recv.h> 24f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 252786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenu8 rtl8723au_read8(struct rtw_adapter *padapter, u16 addr) 26f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 27f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); 28f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct usb_device *udev = pdvobjpriv->pusbdev; 292786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen int len; 302786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen u8 data; 31f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 32f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger mutex_lock(&pdvobjpriv->usb_vendor_req_mutex); 332786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen len = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), 342786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_CMD_REQ, REALTEK_USB_VENQT_READ, 352786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen addr, 0, &pdvobjpriv->usb_buf.val8, sizeof(data), 362786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen RTW_USB_CONTROL_MSG_TIMEOUT); 37f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 382786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen data = pdvobjpriv->usb_buf.val8; 39f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex); 40f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 41f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return data; 42f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 43f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 442786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenu16 rtl8723au_read16(struct rtw_adapter *padapter, u16 addr) 45f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 462786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); 472786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct usb_device *udev = pdvobjpriv->pusbdev; 482786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen int len; 492786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen u16 data; 50f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 512786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_lock(&pdvobjpriv->usb_vendor_req_mutex); 522786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen len = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), 532786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_CMD_REQ, REALTEK_USB_VENQT_READ, 542786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen addr, 0, &pdvobjpriv->usb_buf.val16, sizeof(data), 552786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen RTW_USB_CONTROL_MSG_TIMEOUT); 56f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 572786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen data = le16_to_cpu(pdvobjpriv->usb_buf.val16); 582786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex); 59f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 602786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen return data; 61f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 62f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 632786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenu32 rtl8723au_read32(struct rtw_adapter *padapter, u16 addr) 64f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 652786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); 662786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct usb_device *udev = pdvobjpriv->pusbdev; 672786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen int len; 682786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen u32 data; 69f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 702786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_lock(&pdvobjpriv->usb_vendor_req_mutex); 712786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen len = usb_control_msg(udev, usb_rcvctrlpipe(udev, 0), 722786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_CMD_REQ, REALTEK_USB_VENQT_READ, 732786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen addr, 0, &pdvobjpriv->usb_buf.val32, sizeof(data), 742786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen RTW_USB_CONTROL_MSG_TIMEOUT); 75f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 762786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen data = le32_to_cpu(pdvobjpriv->usb_buf.val32); 772786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex); 78f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 792786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen return data; 80f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 81f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 822786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenint rtl8723au_write8(struct rtw_adapter *padapter, u16 addr, u8 val) 83f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 842786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); 852786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct usb_device *udev = pdvobjpriv->pusbdev; 86f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger int ret; 87f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 882786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_lock(&pdvobjpriv->usb_vendor_req_mutex); 892786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen pdvobjpriv->usb_buf.val8 = val; 90f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 912786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 922786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_CMD_REQ, 932786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_WRITE, 942786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen addr, 0, &pdvobjpriv->usb_buf.val8, sizeof(val), 952786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen RTW_USB_CONTROL_MSG_TIMEOUT); 96f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 972786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen if (ret != sizeof(val)) 982786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = _FAIL; 992786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen else 1002786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = _SUCCESS; 101f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1022786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex); 103f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return ret; 104f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 105f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1062786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenint rtl8723au_write16(struct rtw_adapter *padapter, u16 addr, u16 val) 107f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 1082786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); 1092786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct usb_device *udev = pdvobjpriv->pusbdev; 110f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger int ret; 111f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1122786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_lock(&pdvobjpriv->usb_vendor_req_mutex); 1132786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen pdvobjpriv->usb_buf.val16 = cpu_to_le16(val); 114f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1152786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 1162786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_CMD_REQ, 1172786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_WRITE, 1182786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen addr, 0, &pdvobjpriv->usb_buf.val16, sizeof(val), 1192786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen RTW_USB_CONTROL_MSG_TIMEOUT); 120f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1212786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen if (ret != sizeof(val)) 1222786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = _FAIL; 1232786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen else 1242786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = _SUCCESS; 125f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1262786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex); 127f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return ret; 128f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 129f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1302786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenint rtl8723au_write32(struct rtw_adapter *padapter, u16 addr, u32 val) 131f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 1322786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); 1332786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct usb_device *udev = pdvobjpriv->pusbdev; 134f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger int ret; 135f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1362786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_lock(&pdvobjpriv->usb_vendor_req_mutex); 1372786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen pdvobjpriv->usb_buf.val32 = cpu_to_le32(val); 138f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1392786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 1402786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_CMD_REQ, 1412786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_WRITE, 1422786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen addr, 0, &pdvobjpriv->usb_buf.val32, sizeof(val), 1432786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen RTW_USB_CONTROL_MSG_TIMEOUT); 144f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1452786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen if (ret != sizeof(val)) 1462786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = _FAIL; 1472786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen else 1482786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = _SUCCESS; 149f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1502786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen mutex_unlock(&pdvobjpriv->usb_vendor_req_mutex); 151f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return ret; 152f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 153f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1542786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensenint rtl8723au_writeN(struct rtw_adapter *padapter, u16 addr, u16 len, u8 *buf) 155f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 1562786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct dvobj_priv *pdvobjpriv = adapter_to_dvobj(padapter); 1572786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen struct usb_device *udev = pdvobjpriv->pusbdev; 158f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger int ret; 159f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1602786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen ret = usb_control_msg(udev, usb_sndctrlpipe(udev, 0), 1612786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_CMD_REQ, 1622786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen REALTEK_USB_VENQT_WRITE, 1632786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen addr, 0, buf, len, RTW_USB_CONTROL_MSG_TIMEOUT); 164f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 1652786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen if (ret != len) 1662786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen return _FAIL; 1672786faa33bfc8d61b4fa45dd2e31664de796c837Jes Sorensen return _SUCCESS; 168f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 169f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 170f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger/* 171f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Description: 172f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Recognize the interrupt content by reading the interrupt 173f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * register or content and masking interrupt mask (IMR) 174f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * if it is our NIC's interrupt. After recognizing, we may clear 175f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * the all interrupts (ISR). 176f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Arguments: 177f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * [in] Adapter - 178f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * The adapter context. 179f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * [in] pContent - 180f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Under PCI interface, this field is ignord. 181f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Under USB interface, the content is the interrupt 182f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * content pointer. 183f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Under SDIO interface, this is the interrupt type which 184f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * is Local interrupt or system interrupt. 185f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * [in] ContentLen - 186f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * The length in byte of pContent. 187f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * Return: 188f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * If any interrupt matches the mask (IMR), return true, and 189f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * return false otherwise. 190f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger */ 191f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingerstatic bool 192f7c92d2cc2beb3367f244480300eaecdd9502932Larry FingerInterruptRecognized8723AU(struct rtw_adapter *Adapter, void *pContent, 193f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger u32 ContentLen) 194f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 195f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct hal_data_8723a *pHalData = GET_HAL_DATA(Adapter); 196f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger u8 *buffer = (u8 *)pContent; 197f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct reportpwrstate_parm report; 198f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 199f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger memcpy(&pHalData->IntArray[0], &buffer[USB_INTR_CONTENT_HISR_OFFSET], 200f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 4); 201f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pHalData->IntArray[0] &= pHalData->IntrMask[0]; 202f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 203f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* For HISR extension. Added by tynli. 2009.10.07. */ 204f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger memcpy(&pHalData->IntArray[1], 205f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger &buffer[USB_INTR_CONTENT_HISRE_OFFSET], 4); 206f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pHalData->IntArray[1] &= pHalData->IntrMask[1]; 207f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 208f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* We sholud remove this function later because DDK suggest 209f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * not to executing too many operations in MPISR */ 210f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 211f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger memcpy(&report.state, &buffer[USB_INTR_CPWM_OFFSET], 1); 212f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 2137438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen return (pHalData->IntArray[0] & pHalData->IntrMask[0]) != 0 || 2147438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen (pHalData->IntArray[1] & pHalData->IntrMask[1]) != 0; 215f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 216f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 2172296fd2d928c2cb9d601cdeef5e41eea4c120b88Jes Sorensenstatic void usb_read_interrupt_complete(struct urb *purb) 218f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 219f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger int err; 220f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct rtw_adapter *padapter = (struct rtw_adapter *)purb->context; 221f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 222f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (padapter->bSurpriseRemoved || padapter->bDriverStopped || 223f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->bReadPortCancel) { 224f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("%s() RX Warning! bDriverStopped(%d) OR " 225f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "bSurpriseRemoved(%d) bReadPortCancel(%d)\n", 226f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches __func__, padapter->bDriverStopped, 227f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->bSurpriseRemoved, 228f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->bReadPortCancel); 229f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return; 230f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 231f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 232f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (purb->status == 0) { 233f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct c2h_evt_hdr *c2h_evt; 234f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 235f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger c2h_evt = (struct c2h_evt_hdr *)purb->transfer_buffer; 236f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 237f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (purb->actual_length > USB_INTR_CONTENT_LENGTH) { 238f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("usb_read_interrupt_complete: purb->actual_" 239f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "length > USB_INTR_CONTENT_LENGTH\n"); 240f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger goto urb_submit; 241f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 242f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 243f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger InterruptRecognized8723AU(padapter, purb->transfer_buffer, 244f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger purb->actual_length); 245f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 246f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (c2h_evt_exist(c2h_evt)) { 247f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (c2h_id_filter_ccx_8723a(c2h_evt->id)) { 248f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* Handle CCX report here */ 2497438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen handle_txrpt_ccx_8723a(padapter, (void *) 2507438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen c2h_evt->payload); 251980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen schedule_work(&padapter->evtpriv.irq_wk); 252f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } else { 253980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen struct evt_work *c2w; 254980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen int res; 255980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen 256f9de4a30a5e647bff71509d6f5d419f6967ba291Sachin Kamat c2w = kmalloc(sizeof(struct evt_work), 257980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen GFP_ATOMIC); 258980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen 259980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen if (!c2w) { 260980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen printk(KERN_WARNING "%s: unable to " 261980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen "allocate work buffer\n", 262980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen __func__); 263980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen goto urb_submit; 264980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen } 265980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen 266980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen c2w->adapter = padapter; 267980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen INIT_WORK(&c2w->work, rtw_evt_work); 268980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen memcpy(c2w->u.buf, purb->transfer_buffer, 16); 269980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen 270980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen res = queue_work(padapter->evtpriv.wq, 271980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen &c2w->work); 272980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen 273980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen if (!res) { 274980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen printk(KERN_ERR "%s: Call to " 275980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen "queue_work() failed\n", 276980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen __func__); 277980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen kfree(c2w); 278980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen goto urb_submit; 279980cf72afb0f6eac84d3ea63978db0993b76a3ecJes Sorensen } 280f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 281f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 282f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 283f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingerurb_submit: 284f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger err = usb_submit_urb(purb, GFP_ATOMIC); 285f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (err && (err != -EPERM)) { 286f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("cannot submit interrupt in-token(err = " 287f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "0x%08x), urb_status = %d\n", 288f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger err, purb->status); 289f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 290f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } else { 291f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("###=> usb_read_interrupt_complete => urb " 292f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "status(%d)\n", purb->status); 293f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 294f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger switch (purb->status) { 295f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -EINVAL: 296f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -EPIPE: 297f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -ENODEV: 298f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -ESHUTDOWN: 299f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 300f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port_complete:bSurpriseRemoved =" 301f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "true\n")); 302f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* Fall Through here */ 303f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -ENOENT: 304f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->bDriverStopped = true; 305f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 306f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port_complete:bDriverStopped =" 307f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "true\n")); 308f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 309f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -EPROTO: 310f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 311f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -EINPROGRESS: 31248039e70b647424ee9cf529af7846effb270f417Joe Perches DBG_8723A("ERROR: URB IS IN PROGRESS!\n"); 313f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 314f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger default: 315f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 316f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 317f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 318f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 319f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 32068552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensenint rtl8723au_read_interrupt(struct rtw_adapter *adapter, u32 addr) 321f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 322f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger int err; 323f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger unsigned int pipe; 324ad899b12192ef2fa0cf81a88a320d5a0de4d5151Jes Sorensen int ret = _SUCCESS; 325f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); 326f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct recv_priv *precvpriv = &adapter->recvpriv; 327f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct usb_device *pusbd = pdvobj->pusbdev; 328f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 329f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* translate DMA FIFO addr to pipehandle */ 33097ccc3a6bead88e637c0150b19aaea27387ba6f7Jes Sorensen pipe = usb_rcvintpipe(pusbd, pdvobj->RtInPipe[1]); 331f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 332f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger usb_fill_int_urb(precvpriv->int_in_urb, pusbd, pipe, 333f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvpriv->int_in_buf, USB_INTR_CONTENT_LENGTH, 334f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger usb_read_interrupt_complete, adapter, 1); 335f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 336f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger err = usb_submit_urb(precvpriv->int_in_urb, GFP_ATOMIC); 337f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (err && (err != -EPERM)) { 338f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("cannot submit interrupt in-token(err = 0x%08x)," 339f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "urb_status = %d\n", err, 340f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvpriv->int_in_urb->status); 341f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ret = _FAIL; 342f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 343f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 344f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return ret; 345f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 346f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 347f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingerstatic int recvbuf2recvframe(struct rtw_adapter *padapter, struct sk_buff *pskb) 348f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 349f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger u8 *pbuf; 350f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger u8 shift_sz = 0; 351f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger u16 pkt_cnt; 352f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger u32 pkt_offset, skb_len, alloc_sz; 3537438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen int transfer_len; 3547438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct recv_stat *prxstat; 3557438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct phy_stat *pphy_info; 3567438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct sk_buff *pkt_copy; 3577438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct recv_frame *precvframe; 3587438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct rx_pkt_attrib *pattrib; 3597438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct recv_priv *precvpriv = &padapter->recvpriv; 3607438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct rtw_queue *pfree_recv_queue = &precvpriv->free_recv_queue; 3617438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen 3627438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen transfer_len = (int)pskb->len; 363f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pbuf = pskb->data; 364f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 365f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger prxstat = (struct recv_stat *)pbuf; 366f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pkt_cnt = (le32_to_cpu(prxstat->rxdw2) >> 16) & 0xff; 367f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 368f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger do { 369f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, 370f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("recvbuf2recvframe: rxdesc = offsset 0:0x%08x, " 371f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "4:0x%08x, 8:0x%08x, C:0x%08x\n", prxstat->rxdw0, 372f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger prxstat->rxdw1, prxstat->rxdw2, prxstat->rxdw4)); 373f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 374f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger prxstat = (struct recv_stat *)pbuf; 375f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 376f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvframe = rtw_alloc_recvframe23a(pfree_recv_queue); 377f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (!precvframe) { 378f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, 379f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("recvbuf2recvframe: precvframe == NULL\n")); 380f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("%s()-%d: rtw_alloc_recvframe23a() failed! RX " 381f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches "Drop!\n", __func__, __LINE__); 382f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger goto _exit_recvbuf2recvframe; 383f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 384f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 385f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger INIT_LIST_HEAD(&precvframe->list); 386f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 387f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger update_recvframe_attrib(precvframe, prxstat); 388f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 389f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pattrib = &precvframe->attrib; 390f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 391f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (pattrib->crc_err) { 392f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("%s()-%d: RX Warning! rx CRC ERROR !!\n", 393f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches __func__, __LINE__); 394c5779a0d1feff5d4e16f3bd4b1b17a41aac51d8aJes Sorensen rtw_free_recvframe23a(precvframe); 395f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger goto _exit_recvbuf2recvframe; 396f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 397f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 398f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pkt_offset = RXDESC_SIZE + pattrib->drvinfo_sz + 399f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pattrib->shift_sz + pattrib->pkt_len; 400f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 4017438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen if (pattrib->pkt_len <= 0 || pkt_offset > transfer_len) { 402f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_rtl871x_recv_c_, _drv_info_, 403f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("recvbuf2recvframe: pkt_len<= 0\n")); 404f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("%s()-%d: RX Warning!\n", 405f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches __func__, __LINE__); 406c5779a0d1feff5d4e16f3bd4b1b17a41aac51d8aJes Sorensen rtw_free_recvframe23a(precvframe); 407f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger goto _exit_recvbuf2recvframe; 408f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 409f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 410f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* Modified by Albert 20101213 */ 411f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* For 8 bytes IP header alignment. */ 412f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* Qos data, wireless lan header length is 26 */ 4137438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen if (pattrib->qos) 414f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger shift_sz = 6; 4157438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen else 416f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger shift_sz = 0; 417f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 418f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger skb_len = pattrib->pkt_len; 419f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 420f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* for first fragment packet, driver need allocate 421f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * 1536+drvinfo_sz+RXDESC_SIZE to defrag packet. 422f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * modify alloc_sz for recvive crc error packet 423f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger * by thomas 2011-06-02 */ 4247438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen if (pattrib->mfrag == 1 && pattrib->frag_num == 0) { 425f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* alloc_sz = 1664; 1664 is 128 alignment. */ 426f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (skb_len <= 1650) 427f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger alloc_sz = 1664; 428f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger else 429f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger alloc_sz = skb_len + 14; 430f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } else { 431f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger alloc_sz = skb_len; 432f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* 6 is for IP header 8 bytes alignment in QoS packet case. */ 433f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* 8 is for skb->data 4 bytes alignment. */ 434f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger alloc_sz += 14; 435f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 436f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 437f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pkt_copy = netdev_alloc_skb(padapter->pnetdev, alloc_sz); 438f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (pkt_copy) { 439f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pkt_copy->dev = padapter->pnetdev; 440f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvframe->pkt = pkt_copy; 4417438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen /* force pkt_copy->data at 8-byte alignment address */ 4427438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen skb_reserve(pkt_copy, 8 - 4437438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen ((unsigned long)(pkt_copy->data) & 7)); 4447438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen /*force ip_hdr at 8-byte alignment address 4457438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen according to shift_sz. */ 446f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger skb_reserve(pkt_copy, shift_sz); 4477438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen memcpy(pkt_copy->data, pbuf + pattrib->shift_sz + 4487438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen pattrib->drvinfo_sz + RXDESC_SIZE, skb_len); 449f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger skb_put(pkt_copy, skb_len); 450f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } else { 4517438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen if (pattrib->mfrag == 1 && pattrib->frag_num == 0) { 452f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("recvbuf2recvframe: alloc_skb fail, " 453f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "drop frag frame \n"); 454c5779a0d1feff5d4e16f3bd4b1b17a41aac51d8aJes Sorensen rtw_free_recvframe23a(precvframe); 455f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger goto _exit_recvbuf2recvframe; 456f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 457f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 458f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvframe->pkt = skb_clone(pskb, GFP_ATOMIC); 459f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (!precvframe->pkt) { 460f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("recvbuf2recvframe: skb_clone " 461f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "fail\n"); 462c5779a0d1feff5d4e16f3bd4b1b17a41aac51d8aJes Sorensen rtw_free_recvframe23a(precvframe); 463f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger goto _exit_recvbuf2recvframe; 464f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 465f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 466f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 467f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (pattrib->physt) { 468f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pphy_info = (struct phy_stat *)(pbuf + RXDESC_OFFSET); 469f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger update_recvframe_phyinfo(precvframe, pphy_info); 470f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 471f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 472f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (rtw_recv_entry23a(precvframe) != _SUCCESS) 473f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_rtl871x_recv_c_, _drv_err_, 474f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("recvbuf2recvframe: rtw_recv_entry23a" 475f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "(precvframe) != _SUCCESS\n")); 476f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 477f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pkt_cnt--; 478f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger transfer_len -= pkt_offset; 479f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pbuf += pkt_offset; 480f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvframe = NULL; 481f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pkt_copy = NULL; 482f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 483f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (transfer_len > 0 && pkt_cnt == 0) 484f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pkt_cnt = (le32_to_cpu(prxstat->rxdw2)>>16) & 0xff; 485f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 4867438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen } while (transfer_len > 0 && pkt_cnt > 0); 487f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 488f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger_exit_recvbuf2recvframe: 489f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 490f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return _SUCCESS; 491f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 492f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 493f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingervoid rtl8723au_recv_tasklet(void *priv) 494f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 495f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct sk_buff *pskb; 496f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct rtw_adapter *padapter = (struct rtw_adapter *)priv; 497f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct recv_priv *precvpriv = &padapter->recvpriv; 498f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 499f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger while (NULL != (pskb = skb_dequeue(&precvpriv->rx_skb_queue))) { 5007438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen if (padapter->bDriverStopped || padapter->bSurpriseRemoved) { 501f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("recv_tasklet => bDriverStopped or " 502f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "bSurpriseRemoved \n"); 503f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger dev_kfree_skb_any(pskb); 504f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 505f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 506f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 507f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger recvbuf2recvframe(padapter, pskb); 508f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger skb_reset_tail_pointer(pskb); 509f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 510f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger pskb->len = 0; 511f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 512f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger skb_queue_tail(&precvpriv->free_recv_skb_queue, pskb); 513f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 514f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 515f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 5162296fd2d928c2cb9d601cdeef5e41eea4c120b88Jes Sorensenstatic void usb_read_port_complete(struct urb *purb) 517f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 518f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct recv_buf *precvbuf = (struct recv_buf *)purb->context; 519f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct rtw_adapter *padapter = (struct rtw_adapter *)precvbuf->adapter; 520f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct recv_priv *precvpriv = &padapter->recvpriv; 521f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 522f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 523f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port_complete!!!\n")); 524f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 525f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvpriv->rx_pending_cnt--; 526f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 527f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (padapter->bSurpriseRemoved || padapter->bDriverStopped || 528f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->bReadPortCancel) { 529f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 530f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port_complete:bDriverStopped(%d) OR " 531f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "bSurpriseRemoved(%d)\n", padapter->bDriverStopped, 532f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->bSurpriseRemoved)); 533f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 534f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("%s()-%d: RX Warning! bDriverStopped(%d) OR " 535f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "bSurpriseRemoved(%d) bReadPortCancel(%d)\n", 536f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches __func__, __LINE__, padapter->bDriverStopped, 537f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->bSurpriseRemoved, padapter->bReadPortCancel); 538f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return; 539f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 540f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 541f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (purb->status == 0) { 5427438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen if (purb->actual_length > MAX_RECVBUF_SZ || 5437438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen purb->actual_length < RXDESC_SIZE) { 544f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 545f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port_complete: (purb->actual_" 546f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "length > MAX_RECVBUF_SZ) || (purb->actual_" 547f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "length < RXDESC_SIZE)\n")); 54868552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen rtl8723au_read_port(padapter, RECV_BULK_IN_ADDR, 0, 54968552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen precvbuf); 550f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("%s()-%d: RX Warning!\n", 551f8628a47ba502ec2ec795dc0134f052f45ce2cd4Joe Perches __func__, __LINE__); 552f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } else { 553f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger rtw_reset_continual_urb_error( 554f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger adapter_to_dvobj(padapter)); 555f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 556f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger skb_put(precvbuf->pskb, purb->actual_length); 557f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger skb_queue_tail(&precvpriv->rx_skb_queue, 558f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvbuf->pskb); 559f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 560f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (skb_queue_len(&precvpriv->rx_skb_queue) <= 1) 561f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger tasklet_schedule(&precvpriv->recv_tasklet); 562f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 563f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvbuf->pskb = NULL; 56468552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen rtl8723au_read_port(padapter, RECV_BULK_IN_ADDR, 0, 56568552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen precvbuf); 566f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 567f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } else { 568f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 569f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port_complete : purb->status(%d) != 0 \n", 570f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger purb->status)); 571f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger skb_put(precvbuf->pskb, purb->actual_length); 572f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvbuf->pskb = NULL; 573f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 574f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("###=> usb_read_port_complete => urb status(%d)\n", 575f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger purb->status); 576f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 577f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (rtw_inc_and_chk_continual_urb_error( 578f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger adapter_to_dvobj(padapter))) { 579f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->bSurpriseRemoved = true; 580f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 581f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 582f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger switch (purb->status) { 583f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -EINVAL: 584f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -EPIPE: 585f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -ENODEV: 586f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -ESHUTDOWN: 587f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 588f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port_complete:bSurprise" 589f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "Removed = true\n")); 590f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* Intentional fall through here */ 591f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -ENOENT: 592f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->bDriverStopped = true; 593f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 594f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port_complete:" 595f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "bDriverStopped = true\n")); 596f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 597f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -EPROTO: 598f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -EOVERFLOW: 59968552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen rtl8723au_read_port(padapter, RECV_BULK_IN_ADDR, 0, 60068552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen precvbuf); 601f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 602f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger case -EINPROGRESS: 60348039e70b647424ee9cf529af7846effb270f417Joe Perches DBG_8723A("ERROR: URB IS IN PROGRESS!\n"); 604f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 605f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger default: 606f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 607f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 608f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 609f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 610f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 61168552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensenint rtl8723au_read_port(struct rtw_adapter *adapter, u32 addr, u32 cnt, 61268552a904c86e3e49d53305933371a1225d8aaf2Jes Sorensen struct recv_buf *precvbuf) 613f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 614f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger int err; 615f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger unsigned int pipe; 6167438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen unsigned long tmpaddr; 6177438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen unsigned long alignment; 618ad899b12192ef2fa0cf81a88a320d5a0de4d5151Jes Sorensen int ret = _SUCCESS; 6197438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct urb *purb; 6207438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct dvobj_priv *pdvobj = adapter_to_dvobj(adapter); 6217438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct recv_priv *precvpriv = &adapter->recvpriv; 6227438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen struct usb_device *pusbd = pdvobj->pusbdev; 623f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 624e976cf6f135713cb6f4c904bf24fadfbbf325160Jes Sorensen if (adapter->bDriverStopped || adapter->bSurpriseRemoved) { 625f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 626f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port:(padapter->bDriverStopped ||" 627e976cf6f135713cb6f4c904bf24fadfbbf325160Jes Sorensen "padapter->bSurpriseRemoved)!!!\n")); 628f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return _FAIL; 629f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 630f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 631f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (!precvbuf) { 632f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 633f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("usb_read_port:precvbuf == NULL\n")); 634f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return _FAIL; 635f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 636f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 637f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (!precvbuf->pskb) 638f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvbuf->pskb = skb_dequeue(&precvpriv->free_recv_skb_queue); 639f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 640f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* re-assign for linux based on skb */ 641f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (!precvbuf->pskb) { 642f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvbuf->pskb = netdev_alloc_skb(adapter->pnetdev, MAX_RECVBUF_SZ + RECVBUFF_ALIGN_SZ); 643f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (precvbuf->pskb == NULL) { 644f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, ("init_recvbuf(): alloc_skb fail!\n")); 645f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return _FAIL; 646f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 647f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 648f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger tmpaddr = (unsigned long)precvbuf->pskb->data; 649f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger alignment = tmpaddr & (RECVBUFF_ALIGN_SZ-1); 650f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger skb_reserve(precvbuf->pskb, (RECVBUFF_ALIGN_SZ - alignment)); 651f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 652f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 653f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvpriv->rx_pending_cnt++; 654f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 655f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger purb = precvbuf->purb; 656f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 657f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger /* translate DMA FIFO addr to pipehandle */ 65897ccc3a6bead88e637c0150b19aaea27387ba6f7Jes Sorensen pipe = usb_rcvbulkpipe(pusbd, pdvobj->RtInPipe[0]); 659f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 660f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger usb_fill_bulk_urb(purb, pusbd, pipe, precvbuf->pskb->data, 661f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger MAX_RECVBUF_SZ, usb_read_port_complete, 662f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger precvbuf);/* context is precvbuf */ 663f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 664f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger err = usb_submit_urb(purb, GFP_ATOMIC); 665f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if ((err) && (err != -EPERM)) { 666f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger RT_TRACE(_module_hci_ops_os_c_, _drv_err_, 667f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ("cannot submit rx in-token(err = 0x%.8x), URB_STATUS " 668f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "= 0x%.8x", err, purb->status)); 669f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("cannot submit rx in-token(err = 0x%08x), urb_status " 670f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "= %d\n", err, purb->status); 671f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ret = _FAIL; 672f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 673f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return ret; 674f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 675f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 676f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingervoid rtl8723au_xmit_tasklet(void *priv) 677f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 67824ed8e4575cdd9bf59750755fadbef67af427c88Jes Sorensen int ret; 679f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct rtw_adapter *padapter = (struct rtw_adapter *)priv; 680f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger struct xmit_priv *pxmitpriv = &padapter->xmitpriv; 681f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 682f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (check_fwstate(&padapter->mlmepriv, _FW_UNDER_SURVEY)) 683f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger return; 684f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 685f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger while (1) { 6867438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen if (padapter->bDriverStopped || padapter->bSurpriseRemoved || 6877438ccb93689845d31f5ced3ff6b22eada280d94Jes Sorensen padapter->bWritePortCancel) { 688f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("xmit_tasklet => bDriverStopped or " 689f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger "bSurpriseRemoved or bWritePortCancel\n"); 690f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 691f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 692f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 693f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger ret = rtl8723au_xmitframe_complete(padapter, pxmitpriv, NULL); 694f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 695f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger if (!ret) 696f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger break; 697f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger } 698f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 699f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger 700f7c92d2cc2beb3367f244480300eaecdd9502932Larry Fingervoid rtl8723au_set_hw_type(struct rtw_adapter *padapter) 701f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger{ 702f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->chip_type = RTL8723A; 703f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger padapter->HardwareType = HARDWARE_TYPE_RTL8723AU; 704f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger DBG_8723A("CHIP TYPE: RTL8723A\n"); 705f7c92d2cc2beb3367f244480300eaecdd9502932Larry Finger} 706